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Preface 


It  is  only  a  matter  of  time  until  the  autonomous  mobile 
robot  becomes  a  reality.  The  key  to  achieving  this  goal 
lies  in  the  development  of  a  navigation  system  capable  of 
accurate  position  determination  and  intelligent,  efficient, 
collision-free,  path  planning  through  the  robot's 
environment.  Hopefully,  our  efforts  have  provided  some 
advancement  toward  creating  such  a  robot  navigation  system. 

The  success  of  this  thesis  was  a  direct  result  of  the 
endless  support  provided  by  several  individuals  and 
organizations.  A  special  thanks  goes  to  our  thesis  advisor 
Dr.  Matthew  Kabrisky  for  having  the  confidence  to  turn  us 
loose  on  this  project.  Additionally,  we  would  like  to  thank 
our  sponsor,  Tim  Anderson  of  AFMRL;  Robert  Durham,  Orville 
Wright,  Dick  Wager,  and  Stan  Bashore  of  AFIT/ENG;  Carl 
Short  and  Ron  Ruley  of  AFIT/RMF;  Mrs.  Allis  Moore  of  AFWAL; 
Allen  Cooper,  Berny  Swagert,  and  George  Kelsh  of  King  Radio 
Corporation;  Diane  White,  Ed  Freedman,  and  Cal  Watson  of 
Analog  Devices  Incorporated;  Bill  Lee  and  Roger  Heilman  of 
Sundstrand  Data  Control  Incorporated;  and  a  generous  thanks 
to  King  Radio  Corporation  for  their  donation  of  equipment  to 
the  project. 

We  would  also  like  to  express  our  appreciation  to  Tom 
Clifford  and  Bert  Schneider  for  creating  the  MARRS- 1  robot 
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Abstract 


A  navigation  system  for  a  mobile  autonomous  robot  is 
presented.  The  navigation  system  is  based  upon  a  directional 
gyroscope  and  a  single  axis  accelerometer  which  enables  a 
robot  to  navigate  independent  of  wheel  optical  shaft 
encoders  and  other  commonly  used  positioning  apparatus.  The 
computer  controlled  navigation  system  is  capable  of 
providing  absolute  heading,  heading  rate  (angular  velocity), 
and  linear  velocity  to  a  user  computer.  These  data  from  the 
navigation  system  (heading  and  velocity)  are  used  to  compute 
the  present  location  of  the  robot.  In  addition,  the  heading 
data  is  used  to  form  a  closed  loop  feedback  control  system 
for  maintaining  the  robot  on  a  desired  course.  The 
navigation  system  was  designed  specifically  for  application 
on  an  existing  Air  Force  Institute  of  Technology  (AFIT) 
robot;  however,  it  could  be  easily  adapted  to  any  robot 
system  with  a  standard  IEEE  RS-232  serial  communication 
interface.  Test  results  are  provided  which  demonstrate  the 
use  of  closed  loop  heading  control  on  the  AFIT  robot  and 
which  identify  problems  associated  with  the  use  of  an 
accelerometer  system  for  distance  measurement.  This  thesis 
includes  all  schematics,  parts  lists,  software  listings,  and 
operating  instructions  for  the  navigation  system.  A  new 
robot  world  modeling  and  path  planning  technique  is 
also  presented. 
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GYRO  AND  ACCELEROMETER  BASED  NAVIGATION  SYSTEM 
FOR  A  MOBILE  AUTONOMOUS  ROBOT 


I .  Introduction 

BACKGROUND 

In  general,  robots  fall  into  three  broad  categories: 
fixed  arm  robots,  mobile  robots,  and  mobile  autonomous 
robots.  It  is  important  to  understand  how  these  three 
classes  of  robots  differ. 

A  fixed  arm  robot  is  a  machine  modeled  after  the  human 
arm  and  hand.  It  is  capable  of  armlike  movement  and  has  a 
handlike  manipulator,  but  by  itself  is  incapable  of  movement 
from  one  location  to  another.  Fixed  arm  robots  are  by  far 
the  largest  category  of  present  day  robots,  encompassing 
virtually  all  of  the  currently  available  robots.  They  are 
used  primarily  for  repetitive  manipulative  tasks  such  as 
industrial  assembly  line  work.  Because  these  robots  do  not 
in  general  possess  the  ability  to  move  themselves  about 
their  environment,  they  will  not  be  discussed  further. 

A.  mobile  robot  is  "a  robot  mounted  on  a  moveable 
platform"  [11:17].  They  are  distinguished  by  their  ability 
to  move  freely  about  their  environment,  but  with  command  and 
control  provided  external  to  the  robot.  Underwater  salvage 
robots  provide  an  excellent  example  of  mobile  robotics. 
They  can  move  freely  about  their  environment,  but  are 
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controlled  from  a  surface  vessel  by  a  team  of  human 


operators.  Since  mobile  robots  are  not  self  controlled, 
they  too  will  not  be  discussed  further. 

A  mobile  autonomous  robot  is  "a  robot  acting 
independently  and  of  its  own  volition"  [11:17].  They  are 
distinguished  by  their  ability  to  move  freely  about  their 
environment  completely  under  internal  control  independent  of 
external  machine  or  human  assistance.  Mobile  autonomous 
robots  have  many  potential  applications,  but  currently  they 
do  not  exist  outside  of  research  labs.  Expansion  of  this 
concept  is  the  basis  of  this  thesis. 

In  recent  years,  there  has  been  a  substantial  increase 
of  interest  in  mobile  autonomous  robots.  A  report  regarding 
the  First  World  Conference  on  Robotics  Research,  held  in 
early  1985,  noted  that  one  of  the  most  actively  researched 
fields  was  mobile  autonomous  robots  [11:17],  This  surge  of 
interest  is  a  direct  result  of  the  "microelectronics 
revolution"  which  has  resulted  in  today's  microprocessors 
and  digital  integrated  circuits  (IC's).  Tremendous 
computational  power  is  now  available  in  very  small  packages 
making  the  internal  control  required  for  a  mobile  autonomous 
robot  feasible. 

The  potential  to  develop  a  mobile  autonomous  robot  has 
generated  many  possible  applications.  Chief  among  these  is 
the  performance  of  tasks  hazardous  to  human  personnel  such 
as  fire  fighting,  bomb  disposal,  nuclear  waste  disposal, 
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underwater  salvage  and  repair,  deep  sea  exploration, 
chemical  production,  raining,  sentry  duty,  and  military 
reconaissance  and  attack  missions. 

This  effort  is  being  led  by  the  Department  of  Defense 
(DOD).  The  Defense  Advanced  Research  Projects  Agency 
(DARPA)  currently  has  a  17  million  dollar  contract  with 
Martin  Marrietta  Corporation  to  develop  an  autonomous  land 
vehicle  [21]  and  has  asked  General  Dynamics  and  others  for 
proposals  on  battlefield  robots  [13:48].  DARPA  is  also 
funding  multi-legged  mobile  robotics  research  at  Ohio  State 
University  [13:48]. 

The  Army's  General  Officer  Steering  Committee  for 
Artificial  Intelligence  and  Robotics  recently  issued  a 
report  outlining  near-term  (1980's)  robotic  systems 
applications  [14].  They  include:  a  light  weight  robotic 
vehicle  to  mount  antitank  guided  missiles,  mortars,  and 
small  arms;  a  robotic  obstacle/mine  breaching  tank;  a 
robotic  transport  and  resupply  vehicle;  a  security  sentry 
robot;  an  explosive  ordnance  disposal  robot;  and  a  robot 
scout  vehicle. 

The  Air  Force  Medical  Research  Laboratory  at  Wright- 
Patterson  Air  Force  Base  (WPAFB)  is  currently  working  on  the 
development  of  a  mobile  autonomous  robot  to  service  aircraft 
in  a  nuclear,  biological,  or  chemical  (NBC)  contaminated 
environment.  This  thesis  is  an  extension  of  that  effort. 


All  of  the  above  applications  require  the  rcoot  to  be 


able  to  perform  three  primary  functions:  computation, 
manipulation,  and  navigation. 

Computation  is  the  robot's  ability  to  make  job 
application  related  control  decisions.  For  example,  an 
aircraft  servicing  robot  would  have  to  decide  which 
subsystems  to  test  and  then  which  part  to  replace.  In  the 
field  of  artificial  intelligence,  this  would  be  called  an 
expert  system.  Since  numerous  expert  systems  of  the  type 
required  for  robotics  have  already  been  developed,  this 
function  will  not  be  discussed  further. 

Manipulation  is  the  robot’s  ability  to  skillfully 
handle  and  move  objects  in  its  environment.  This  function 
has  been  well  developed  and  is  commercially  available  in  the 
form  of  a  fixed  arm  robot.  Therefore  this  function  also 
will  not  be  discussed  further. 

Navigation  is  the  robot's  ability  to  direct  itself 
toward  some  destination.  This  problem  has  yet  to  be 
adequately  addressed  and  is  the  major  impediment  to  the 
development  of  a  mobile  autonomous  robot.  Robot  navigation 
is  the  focus  of  this  thesis. 

Navigation  requires  that  the  robot  be  able  to  follow  a 
given  or  calculated  course  of  travel  making  course 
corrections  as  necessary.  This  means  the  robot  must  be 
capable  of  finding  its  current  location  in  reference  to  the 
desired  course.  This  information  is  required  for  steering 
control  feedback  in  order  to  accurately  follow  a  given 
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course . 


In  addition,  the  robot  must  know  its  starting  location 
and  final  destination  on  the  same  frame  of  reference  as  its 
current  location.  This  will  give  it  the  ability  to  know 
when  is  has  arrived  at  the  desired  location. 

Finally,  a  navigation  system  must  provide  a  means  for 
recognizing  obstacles,  both  known  and  unknown.  It  must 
allow  for  course  changes  to  avoid  these  obstacles  and  yet 
still  arrive  at  the  destination  in  a  time  efficient  manner. 
A  robot  must  be  able  to  deal  with  a  dynamic  environment. 

Physically,  the  navigation  system  is  composed  of  sensors 
and  steering  control.  The  sensor  subsystems  collect 
position  and  obstacle  data.  the  steering  control  subsystem 
uses  the  position  and  obstacle  data  to  make  any  necessary 
course  changes.  All  but  the  most  simple  steering  control 
subsystems  require  many  intelligent  decisions  to  be  made  and 
therefore  require  a  computer  as  the  controller. 

Past  research  work  on  mobile  robot  and  mobile 
autonomous  robot  navigation  has  produced  vision,  embedded 
wire,  beacon,  shaft  encoder,  and  sonar  based  navigation 
systems,  where  the  environmental  data  from  each  system's 
sensors  is  interpreted  by  a  computer  to  control  the  path  of 
travel . 

Vision  navigation  systems  use  television  cameras  to 
"see"  the  desired  path  and  obstacles  much  like  a  human. 
Vision  systems  today  are  relatively  crude  in  spite  of  modern 
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advances  in  high  speed  computer  systems.  They  are  not 
capable  of  interpreting  the  digital  video  information  fast 
enough  to  allow  real  time  navigation. 

Dr.  Hans  Moravec  has  done  considerable  research  in  the 
area  of  robotic  vision.  During  his  Ph.D.  work  at  Stanford 
University,  he  experimented  with  the  "Stanford  cart",  a 
mobile  robot  which  he  equipped  with  a  video  camera  [17]. 
The  cart’s  ultimate  achievement  was  travelling  through  an 
obstacle  laden  area  to  a  goal  about  60  feet  away.  The  trip 
took  a  total  of  about  five  hours.  In  addition,  the  cart  did 
no  onboard  processing  of  the  video  images.  They  were 
transmitted  by  radio  link  to  a  VAX  780  computer  which 
interpreted  the  data  and  issued  the  resulting  steering 
commands.  This  reduces  the  robot  to  the  mobile  category  as 
opposed  to  the  mobile  autonomous  classification. 

Dr.  Moravec,  now  a  professor  at  Carnegie  Mellon 
University,  is  still  diligently  pursuing  his  research  into 
creating  human  like  vision  for  a  mobile  robot.  However,  he 
admits  that  to  reach  his  goal  he  needs  a  computer  which  is 
about  1000  times  faster  than  his  current  computer  [9:30]. 
Present  vision  systems  are  not  fast  enough  to  allow  real 
time  navigation  and  the  computers  are  not  small  enough  to  be 
built  on  board  the  robot  for  a  mobile  autonomous  system. 

Embedded  wire  systems  find  the  desired  path  by 
following  wires  on  or  beneath  the  travel  surface  like  a 
train  on  railroad  tracks.  This  system  is  very  simple, 


requires  little  computational  ability,  and  navigation  can  be 
done  in  real  time.  However,  it  is  not  very  flexible. 
Places  of  travel  are  limited  to  where  the  wire  tracks  are 
located  and  continuity  of  the  wire  from  start  to 
destination.  Obstacle  avoidance  is  impossible  without 
additional  sensors  and  even  then  would  be  limited  to 
stopping  and  waiting  for  the  obstacle  to  move. 

Beacon  systems  determine  the  desired  path  from  position 
reference  information  broadcast  by  beacons  found  near  the 
path  of  travel.  This  system  is  also  simple,  easy  to 
implement,  and  provides  a  real  time  navigation  capability. 
It  suffers  from  the  need  to  provide  beacons  in  the  robots 
working  environment  for  navigation.  Additional  sensors  are 
required  to  provide  an  obstacle  avoidance  capability. 

Optical  shaft  encoder  systems  rely  on  "dead  reckoning" 
navigation  by  starting  at  a  known  position  and  moving 
precise  distances  as  measured  by  the  optical  shaft  encoder. 
This  is  also  a  relatively  simple  system,  easy  to  implement, 
and  can  be  done  in  real  time.  It  is  more  flexible  than  the 
embedded  wire  system  because  it  is  not  limited  to  following 
wire  tracks,  but  it  suffers  from  errors  in  sensor  data.  The 
distance  moved  data  must  be  very  accurate  or  error  will  be 
introduced  that  is  cumulative  and  will  eventually  result  in 
the  robot  becoming  lost. 

Optical  shaft  encoders  have  proven  to  be  fairly 
accurate  under  ideal  conditions.  However,  several  sources 


of  position  error  accompany  their  use.  These  position 
errors  are  unbounded  and  cumulative.  One  error  source  is 
wheel  slippage,  resulting  in  an  inaccurate  measurement  of 
actual  distance  traveled. 

A  second  problem  lies  in  knowing  the  exact 
circumference  of  the  wheel.  The  distance  traveled  by  the 
robot  is  determined  from  the  number  of  revolutions  made  by 
the  wheel;  one  revolution  of  wheel  travel  equals  the 
distance  of  one  circumference  in  linear  travel.  As  the  tire 
wears  out,  the  error  in  the  measured  distance  grows  larger. 

A  third  problem  results  from  computational  errors.  This 
error  is  most  prominent  when  the  robot  has  negotiated  many 
turns,  requiring  numerous  calculations  based  on  geometric 
approximations  to  determine  the  current  location  of  the 
robot.  After  a  short  period  of  travel,  the  robot  will  begin 
to  stray  off  course  due  to  an  accumulation  of  error.  The 
performance  of  optical  shaft  encoders  degrades  considerably 
as  the  number  of  maneuvers  performed  by  the  robot  increases. 

A  fourth  problem  with  optical  shaft  encoders  results 
from  not  having  an  absolute  heading  reference.  All  heading 
computations  from  encoder  data  produce  a  relative  heading  to 
some  initial  heading.  Initial  heading  of  the  robot  must  be 
externally  provided  and  can  itself  be  a  very  large  error 
source.  In  Figure  1.1,  the  effect  of  initial  heading  error 
is  illustrated.  Without  an  accurate  initial  heading,  the 
robot  will  eventually  become  lost.  A  robot  system  using 


Desired  Path 
Actual  Path 


x  =  Intended  Destination 
*  =  Actual  Destination 
0-  =  Initial  Heading  Error 


Figure  1.1.  Effect  of  initial  heading  error. 

optical  shaft  encoders  for  navigation  is  highly  dependent 
on  this  initial  heading  reference. 

Finally,  optical  shaft  encoders  offer  no  means  for 
detecting  obstacles.  Therefore,  additional  sensors  are 
required  to  provide  an  obstacle  avoidance  capability. 
Sonars  (ultrasonic  ranging  units)  can  be  used  to  complement 
the  optical  shaft  encoders  and  together  provide  position  and 
obstacle  detection  information.  In  addition,  the  sonars  can 
be  used  to  compensate  for  errors  in  the  encoders  by 
providing  range  information  to  known  obstructions.  In  other 


words,  the  sonars  can  provide  a  position  "fix"  so  the  robot 
knows  its  location  with  respect  to  its  known  environment. 

Dr.  James  Crowley  [12]  is  experimenting  with  just  such 
a  system.  He  uses  a  focused  rotating  ultrasonic  ranging 
device  to  maintain  a  description  of  the  robots  external 
environment.  This  description  is  called  a  sensor  model. 
The  estimated  position  of  the  robot,  obtained  from  optical 
shaft  encoders,  is  compared  to  the  position  of  the  robot 
determined  from  the  sensor  model  to  create  a  composite 
model.  This  composite  model  represents  an  average  position 
of  the  robot.  In  this  way,  Crowley  seeks  to  maintain  an 
accurate  estimate  of  the  robots  position. 

It  is  not  very  feasible  to  use  sonars  as  the  only 
source  of  navigation  data  since  their  range  is  limited 
(making  navigation  through  a  large  open  area  impossible)  and 
unknown  obstacles  could  be  misinterpreted  as  known  obstacles 
causing  the  robot  to  become  lost.  It  is  also  important  to 
note  that  sonar  data  is  useless  for  navigation  without  an 
accurate  heading  reference.  A  detected  object  cannot  be 
used  as  a  reference  without  knowing  the  direction  of  the 
object  in  the  navigation  reference  frame. 

Previous  thesis  work  at  the  Air  Force  Institute  of 
Technology  (AFIT)  has  produced  a  mobile  robot,  the  Mobile 
Autonomous  Robot  Research  System- 1  (MARRS-1),  that  can  map 
its  environment  and  provide  obstacle  detection  with  sonar 
It  can  also  measure  distance  travelled  with 
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sensors. 


optical  shaft  encoders.  In  addition,  the  robot  has  an 
onboard  computer  for  dedicated  navigation  calculations. 
However,  MARRS-1  is  not  capable  of  autonomous  navigation. 
The  current  navigation  system  can  only  traverse  a  course 
preprogrammed  into  the  drive  computer  through  the  robot's 
keyboard  or  by  use  of  the  teaching  pendant.  It  can  only 
collect,  not  use  for  navigation,  sonar  obstacle  information 
and  shaft  encoder  distance  data  (as  presently  programmed). 
In  addition,  it  is  not  able  to  compensate  for  errors  in 
wheel  direction  and  distance  measurements,  which  may  cause 
MARRS-1  to  wander  from  the  programmed  course  (open  loop 
steering  control). 

It  is  obvious  that  past  robot  navigation  research,  both 
at  AFIT  and  abroad,  has  not  produced  an  accurate,  real  time, 
autonomous,  mobile  navigation  system.  A  new  approach  Is 
indicated  by  the  weaknesses  and  liabilities  of  past  systems. 
First,  an  absolute  and  directly  measurable  robot  heading 
reference  is  required.  Second,  an  accurate  and  preferably 
non-mechanical  method  of  distance  measurement  is  necessary. 
Third,  an  accurate,  long  distance  (5  to  50  feet  or  more) 
method  of  obstacle  detection  is  required.  Finally,  a 
navigation  algorithm  is  required  that  models  the  sensor  data 
into  a  real  world  map  and  issues  robot  steering  commands 
based  on  this  mapping. 

This  thesis  attempts  to  solve  these  problems  by 


adapting  an  aircraft  directional  gyroscope  system  for  the 


heading  reference,  an  accelerometer  for  distance 
measurement,  and  sonars  for  obstacle  detection.  Robot 
"world  modeling"  and  path  planning  is  discussed,  but  not 
implemented. 

PROBLEM  AND  SCOPE 

The  problem  is  to  design  and  fabricate  a  real  time, 
point  to  point,  closed  loop,  mobile  autonomous  robot 
navigation  system  for  the  MARRS-1  robot.  In  addition,  it 
must  be  capable  of  detecting  and  avoiding  both  previously 
known  and  unknown  obstacles. 

Real  time  navigation  is  defined  to  be  navigation  at  the 
maximum  constant  motion  travel  speed  of  MARRS-1.  Point  to 
point  refers  to  navigation  from  a  given  starting  point  to  a 
given  destination  and  includes  in-course  obstacle  detection 
and  avoidance.  Closed  loop  refers  to  the  ability  to  detect 
and  correct  course  errors.  Autonomous,  in  this  case,  will 
be  broadened  to  mean  needing  no  external  support  except 
power . 

Design  and  fabrication  will  include:  construction  of  a 
new  third  body  tier  to  house  the  gyro  and  accelerometer 
based  navigation  system  (GYRAC);  physical  and  electrical 
modification  of  MARRS-1  to  allow  GYRAC  integration; 
fabrication  of  a  GYRAC  control  computer;  implementation  of 
GYRAC  computer  software;  fabrication  of  a  digital  electronic 
interface  between  the  gyro/accelerometer  and  GYRAC  computer; 


integration  of  the  MARRS-1  drive  and  navigation  computers 
with  the  GYRAC  computer;  a  simple  point  to  point  navigation 
control  program  (no  obstacle  avoidance)  to  demonstrate 
course  tracking;  full  testing  of  all  new  hardware  and 
compilation  of  test  results;  complete  schematic  diagrams  and 
operating  manuals  for  all  new  hardware;  and  fully  documented 
software  listings  for  all  operational  and  test  programs. 

Obstacle  detection  and  avoidance  were  not  implemented, 
but  are  available  since  this  has  been  demonstrated  on  a 
previous  thesis  [19].  Finally,  the  design  options  available 
were  limited  by  hardware  and  software  restrictions  imposed 
by  systems  previously  added  to  MARRS-1,  limited  space 
internal  to  the  robot,  limited  time,  and  insufficient  funds. 

u 


Assumptions 

Several  basic  assumptions  are  necessary  for  a 
navigation  system  based  on  a  directional  gyroscope  and  an 
accelerometer.  This  thesis  is  predicated  on  the  following 
assumptions : 

1.  Assume  no  local  disturbances  will  be  present  in  the 
earths  magnetic  field.  This  assumption  is  necessary 
since  the  directional  gyro  output  is  slaved  to  a 
magnetic  flux  detector  for  absolute  reference  to 
magnetic  north. 

2.  Assume  the  operational  environment  of  the  robot  is 
a  perfectly  smooth  and  level  surface.  This 
assumption  is  necessary  since  a  single 
accelerometer  cannot  distinguish  true  acceleration 
from  local  gravity.  Therefore,  any  tilt  of  the 
accelerometer  input  axis  into  the  vertical  plane 
will  induce  an  error  in  measured  acceleration. 
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Assume  a  perfect  integrator.  An  operational 
amplifier  integrator  circuit  is  used  to  integrate 
accelerometer  output  to  obtain  velocity. 

4.  Assume  velocity  of  the  robot  is  constant  over 
sample  period.  This  is  necessary  for  simplicity 
and  ease  of  calculation. 

5.  Assume  sample  time  is  known  precisely.  Using 

accelerometer  output  to  ultimately  obtain  distance 
traveled  by  the  robot  is  a  time  dependent  problem. 

All  the  above  assumptions,  excluding  the  first,  are 
tied  directly  to  the  use  of  an  accelerometer.  Each  of  these 
assumptions  will  be  addressed  again  in  Chapter  V. 

Evolution  and  Capability  of  MARRS- 1 

The  MARRS- 1  began  as  a  Heathkit  HERO- 1  robot.  This 
original  HERO- 1  has  since  undergone  substantial  modification 
and  today  bears  little  resemblance  to  its  former  self. 
Lieutenant  Owen  [19]  was  the  first  to  modify  the  original 
HERO- 1 .  He  added  a  laser  barcode  scanner  and  several 
Polaroid  ultrasonic  ranging  units  to  the  robot.  The  scanner 
was  used  to  determine  the  location  of  the  robot  by  reading 
barcodes  taped  to  the  floor.  The  first  step  had  been  taken 
toward  creating  an  autonomous  mobile  robot.  The  HERO- 1 
could  collect  useful  but  limited  navigation  data  on  its  own. 

Eollow-on  work  by  Clifford  and  Schneider  [10]  was  a 
major  leap  toward  the  goal  of  creating  a  mobile  autonomous 
robot.  Under  their  thesis  effort,  the  HERO- 1  was  completely 
rebuilt.  The  following  is  a  list  of  the  major  modifications 
performed  by  Clifford  and  Schneider: 

1.  A  new  main  body  was  fabricated.  This  new  body  is  12 
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sided  and  consists  of  two  separate  levels.  The  top 
level  can  rotate  with  respect  to  the  lower  level. 

2.  The  HERO-1  CPU  (MC6808)  was  upgraded  with  the 
addition  of  a  Virtual  Devices  Inc.  MENOS-1  MC6801 
CPU  board  which  added  RS-232  serial  communication 
capability  to  the  HERO-1. 

3.  Two  dozen  Polaroid  sonar  transducers  were  attached 
to  the  new  robot  body  (one  on  each  segment  of  the 
upper  and  lower  body  decks). 

4.  Optical  shaft  encoders  were  placed  on  the  two  rear 
wheel  shafts  and  on  the  front  (drive)  wheel 
steering  shaft  to  provide  distance  moved  data. 

5.  An  MC6802  based  computer  was  added  to  control  the 
optical  shaft  encoder  subsystem  and  the  sonar 
subsystem.  This  computer  is  called  the  Navigation 
computer. 

The  resulting  heavily  modified  HERO-1  was  renamed 
MARRS-1.  MARRS-1  was  then  used  to  generate  sonar  range  data 
and  wheel  distance  data.  This  data  was  post  processed  on  an 
external  computer  to  create  a  composite  map  of  the  robot's 
local  environment  relative  to  the  robot  (whose  position  was 
determined  from  the  shaft  encoder  data).  This  represents  a 
significant  improvement  over  the  capability  of  the  Owen 
modified  HERO- 1 .  However,  like  Owen’s  modified  HERO- 1 ,  the 
MARRS-1  served  only  as  a  collector  of  navigation  data.  The 
actual  movement  of  the  robot  was  controlled  by  a  human 
operator.  MARRS-1  was  not  yet  an  autonomous  robot,  but  it 
possessed  the  capability  to  become  one. 

The  capability  of  the  MARRS-1  at  the  beginning  of  this 
thesis  can  be  summarized  as  follows: 

1.  All  functions  of  the  original  HERO- 1  still  existed, 
except  for  the  arm  [10:111-3].  This  capability 
included  programable  movement  of  the  robot. 


Unfortunately,  this  programed  motion  was  open  loop, 
resulting  in  unreliable  and  nonrepeatable  movement. 
The  robot  could  not  follow  a  straight  line  path. 

2.  The  laser  barcode  scanner  was  removed  but  all 
provisions  for  attaching  it  (both  mechanically  and 
electrically)  to  the  robot  still  existed. 

3.  Sonar  and  optical  shaft  encoder  data  could  be 
gathered  by  the  navigation  computer  and  relayed  via 
an  RS-232  computer  interface  to  an  external 
computer  for  storage  on  a  floppy  disk.  Firmware  was 
resident  onboard  the  Navigation  computer  to  obtain 
and  transmit  the  data. 

4.  Four  RS-232  computer  interface  ports  were  available 
for  use.  One  port  allowed  communication  with  the 
main  CPU  (MENOS-1  upgrade  board).  The  other  three 
ports  allowed  access  to  the  navigation  computer. 


General  Approach 

Development  of  a  mobile  autonomous  robot  navigation 
system  for  the  MARRS-1  required  a  rigorous  analysis  of  past 
and  present  robot  navigation  research  literature.  Based  on 
this  literature  search,  a  new  approach  to  world  modeling  for 
mobile  autonomous  robots  was  developed. 

This  new  navigation  approach  required  collection  of 
specific  types  of  data.  The  current  systems  and  sensors  on 
the  MARRS- 1  were  compared  against  these  new  requirements  and 
a  list  of  sensors  and  systems  to  be  constructed  were 
compiled.  A  prime  requisite  during  this  analysis  was  to 
limit  the  data  collected  so  that  onboard  computers  could 
process  the  data  fast  enough  to  allow  real  time  navigation. 

The  required  sensors  and  subsystems  were  built  and 
tested  as  was  the  necessary  software  to  drive  each 


subsystem. 


Modifications  were  then  made  to  the  MARRS-1 


system  to  allow  the  GYRAC  subsystem  to  be  physically, 
electrically,  and  functionally  (through  software)  integrated 
onto  the  MARRS-1  platform.  Navigation  system  testing  was 
performed  and  supporting  data  collected  to  validate  the  new 
navigation  system. 

Finally,  MARRS-1  system  software  was  developed,  tested, 
and  support  data  collected  to  demonstrate  the  feasibility  of 
gyro  based  steering  control.  Conclusions  and  recommend¬ 
ations  are  provided  based  on  testing  at  each  of  the  various 
stages. 

Sequence  of  Presentation 

Chapter  One  provides  a  detailed  problem  background, 
problem  statement  and  scope,  assumptions,  evolution  of 
MARRS-1,  general  approach,  and  sequence  of  presentation. 
Chapter  Two  covers  the  GYRAC  system  design  and  theory  of 
operation.  Chapter  Three  discusses  GYRAC  system  integration 
onto  the  MARRS-1  platform.  Chapter  Four  presents  a  new 
mobile  autonomous  robot  navigation  theory  for  world 
modelling  and  path  planning.  Chapter  Five  discusses  testing 
results  and  analysis  of  the  various  stages  of  the  GYRAC 
development.  Chapter  Six  gives  a  system  summary  and 
presents  conclusions  and  recommendation.  The  appendices 
contain  hardware  data  sheets,  schematic  diagrams,  device 
layouts,  wiring  diagrams,  connector  diagrams,  an  equipment 
list,  and  a  parts  list.  Included  are  software  structure 


II.  GYRAC  Design  and  Theory  of  Operation 


The  hardware  design  goal  of  this  thesis  is  to  create  a 
navigation  data  system  capable  of  providing  absolute  heading 
and  velocity  data,  in  binary  digital  form,  to  an  external 
computer.  Three  primary  requirements  are  the  basis  for  this 
design : 

1.  A  KCS-55A  Pictorial  Navigation  System  (produced  by 

King  Radio  Corp. )  was  ordered  after  selection  as 

the  best  directional  gyro  system  for  this  project 
and  a  QA-1100  accelerometer  (produced  by  Sundstrand 
Data  Control  Inc.)  was  already  on  hand  at  AFIT. 
Therefore,  the  system  must  be  centered  around  the 
KCS-55A  Pictorial  Navigation  System  and  the  QA-1100 
accelerometer. 

2.  The  navigation  data  system  must  be  compatible  with 

the  MARRS-1  but  also  easily  transportable  to 

another  robot  system. 

3.  The  system  must  be  attainable  with  resources 

readily  available  to  AFIT. 


Since  the  foundation  of  the  system  is  a  gyro  and  an 
accelerometer,  the  navigation  data  system  will  hereafter  be 
refered  to  as  the  "GYRAC"  system  (for  gyro  and  acceler¬ 
ometer  system). 


Summary  of  GYRAC  System 

A  general  layout  of  the  GYRAC  system  can  be  seen  in  the 
block  diagram  in  Figure  2.1.  The  gyro  subsystem  provides 
analog  heading  information  which  is  then  converted  to  a  12 
bit  TTL  (Transistor  Transistor  Logic)  digital  data  signal. 
Angular  velocity  is  a  byproduct  of  this  conversion  in  analog 
signal  form.  Thus,  the  analog  angular  velocity  is  digitized 


gure  ?.1.  GYHAC  System  Block  Diagram 


through  an  analog-to-digital  converter  resulting  in  a  10  bit 
digital  data  signal.  The  accelerometer  produces  an  analog 
signal  which  is  integrated  via  an  operational  amplifier 
circuit  and  converted  to  digital  TTL  data  by  an  analog-to- 
digital  converter.  The  three  digital  data  signals  are 
connected  to  a  common  thirteen  wire  bus  containing  eight 
data  lines,  four  address  lines,  and  a  read/write  line.  This 
bus  serves  as  a  standard  sensor  interface  to  the  GYRAC 
computer.  The  GYRAC  computer  interprets  commands  received 
from  an  external  computer  via  an  RS-232  serial  data  link  and 
acquires  the  appropriate  sensor  data  as  directed  by  the 
external  command.  The  GYRAC  computer  then  performs  any 
necessary  preprocessing  of  the  data,  converts  it  to  serial 
format,  and  transmits  it  to  the  external  computer  via  the 
RS232  link. 

The  Gyro  Subsystem. 

The  gyro  subsystem  is  composed  of  four  major  elements: 
a  directional  gyro;  an  indicator  unit;  a  magnetic  flux 
detector;  and  a  slaving  unit.  The  directional  gyro  provides 
a  gyro  stabilized  magnetic  heading  to  the  indicator.  The 
directional  gyro  consists  of  two  primary  components:  the 
gyro  itself  and  a  base  assembly,  see  Figure  2.2. 

The  gyro  is  a  spinning  mass  precision  gyro  with  two 
degrees  of  freedom,  see  Figure  2.3.  Relative  angular 


displacement  is  sensed  by  an  optical  encoder  assembly 
mounted  on  the  gyro's  outer  gimbal.  Electrical  outputs  from 


the  optical  encoder  are  two  square  waves  which  are  used  to 
drive  a  stepper  motor  in  the  indicator.  The  gyro  base 
assembly  contains  the  control  logic  for  the  gyro  and  the 
slaving  logic  for  the  indicator.  The  gyro  base  also  serves 
as  the  power  supply  for  the  entire  gyro  subsystem.  From  the 
single  28  volts  DC  input  into  the  gyro  base,  the  following 


internal  voltage  supplies  are  generated:  26  VAC  400  Hz  for 
the  gyro  spin  motor,  flux  detector  excitation,  and  heading 
syncro  excitation;  +  and  -  15  VDC  regulated  supply  for  the 
analog  circuitry  in  the  system;  +15  VDC  unregulated  voltage 
fo~  the  stepper  motor  in  the  indicator;  and  +5  VDC  regulated 


supply  for  the  system  digital  logic  circuitry  [3:5-33]. 
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Figure  2.4.  The  Heading  Indicator  [1:2-9] 

Also,  separate  regulated  grounds  are  maintained  for  the 
analog  and  digital  circuitry.  For  the  GYRAC  system,  the 
above  mentioned  supplies  and  grounds  are  routed  to  a  central 
power  distribution  panel  to  provide  the  necessary  power  for 
other  GYRAC  hardware  (see  Appendix  E). 

The  indicator  is  typical  of  the  type  seen  in  the 
cockpit  of  small  aircraft,  as  shown  in  Figure  2.4.  A  digital 
stepper  motor  is  used  to  drive  the  heading  display  in 
response  to  the  signals  generated  in  the  directional  gyro. 
The  signals  from  the  gyro  consist  of  a  two  phase  excitation 
drive  that  is  connected  to  the  four  stepper  motor  leads  as 
shown  in  Figure  2.5.  Each  time  the  A  or  Q  waveforms  (see 
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terminals  will  be: 


31  to  S3  =  A  sin(wt)  sin  -9- 

S3  to  S2  =  A  sin(wt)  sin(  -0-  +  120  ) 

S2  to  SI  =  A  sin(wt)  sin(  -9-  +  240  ) 

where  -0-  is  the  shaft  angle. 

These  voltages  are  known  as  syncro  format  voltages 
[18:2].  A  desirable  result  of  the  syncro  output  is  that  it 
can  be  easily  converted  to  a  digital  signal  with  a  standard 
syncro-to-digital  (S/D)  converter.  An  SDC1700  12  bit  S/D 
converter  made  by  Analog  Devices  is  used  (see  Appendix  A  and 
C)  to  provide  a  TTL  digital  binary  representation  of  the 
heading  angle  (shaft  angle).  The  SDC1700  also  provides  an 
angular  velocity  output  in  analog  form  which  will  be 
converted  to  digital  by  an  analog-to-digital  (A/D) 
converter.  The  A/D  converter  to  be  used  is  also  produced  by 
Analog  Devices  and  is  a  10  bit  converter  (Part  a  AD573,  see 
Appendix  A  and  C  for  detail). 

The  magnetic  flux  detector  senses  the  direction  of  the 
earth's  magnetic  field  and  converts  this  information  to  a 
three-wire  syncro  format,  much  like  the  CX  in  the  indicator. 
This  information  is  transmitted  to  the  indicator  for  slaving 
purposes,  see  Figure  2.8  for  an  exploded  view  of  the 
detector.  The  flux  detector  can  be  oriented  so  the  gyro 
system  displays  a  heading  relative  to  some  artificial  North 
direction.  This  feature  is  used  to  align  the  GYRAC  system 
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Figure  2.9.  Slaving  Unit  [1:2-19] 


with  some  convenient  navigation  coordinate  system  in  the 
test  area. 

The  slaving  unit,  shown  in  Figure  2.9,  contains  a 
slaving  meter,  slaving  switches,  and  corrector  circuitry 
which  can  compensate  for  the  effect  of  local  magnetic 
disturbances  on  the  flux  detector.  The  meter  current  is 
generated  in  the  directional  gyro  base  assembly  (slaving 
logic)  and  represents  the  difference  between  the  flux 
detector  sensed  heading  and  the  heading  displayed  on  the 
indicator.  The  slaving  switches  allow  the  gyro  system  to  be 
operated  in  either  a  free-gyro  mode  (no  slaving  with  the 
flux  detector)  or  in  the  slaved  mode  (automatic  slaving  with 
flux  detector).  There  is  also  a  manual  slaving  switch  which 


can  be  used  to  rotate  the  display  card  in  the  indicator 
either  clockwise  or  counter-clockwise.  In  addition  to  the 
slaving  meter  and  slave  switching  functions,  the  slaving 
unit  also  Includes  a  compensation  circuit.  This  circuit 
causes  a  shift  in  the  magnetic  direction  vector  and  thus  can 
compensate  for  "hard  iron"  effects  caused  by  nearbye  ferrous 
materials. 

The  Accelerometer  Subsystem. 

The  accelerometer  used  in  this  thesis  is  a  QA-1100 
servo- type  single-axis  accelerometer  produced  by  Sundstrand 
Data  Control  Incorporated  (see  Figure  2.10).  The  sensor,  as 


Figure  2.10.  The  QA-1100  Accelerometer  [20] 


shown  in  Figure  2.11,  consists  of  the  following  key  elements 
[7:1-3]: 


1.  A  proof  mass,  pendulously  supported  and  ideally 
constrained  so  as  to  allow  only  one  degree  of 
freedom  about  a  well  defined  axis  fixed  within  the 


Figure  2.11 


Basic  Structure  of  a  Servo-Type  Accelerometer 
[7:1-3] 


sensor. 

2.  A  pick-off  that  can  sense  extremely  small  displace¬ 
ments  of  the  proof  mass. 

3.  A  torquer,  which  is  a  coil  positioned  within  a 
permanent  magnetic  field  and  attached  to  the  proof 
mass,  allowing  force  to  be  applied  to  the  proof 
mass  in  response  to  a  current  passed  through  the 
coil . 

4.  A  restorer  circuit,  or  servo,  that  causes  an 
electrical  current  to  flow  through  the  torquer  coil 
in  response  to  a  pick-off  signal.  The  resulting 
electromagnetic  force  balances  the  inertial 
reactive  forces. 


The  basic  operation  of  the  accelerometer  is  that  of  a 
linear  single  axis  electro-mechanical  device  for  measuring 
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acceleration.  The  operation  is  based  on  movement  of  the 
proof  mass  during  acceleration.  A  pickoff  senses  the 
displacement  of  the  mass  and  the  servo  amplifier  develops  a 
current  which  is  supplied  through  the  torque  coil  to 
rebalance  the  proof  mass.  Thus,  the  rebalance  current  is 
proportional  to  the  sensed  acceleration  and  is  a  very 
accurate  measure  of  acceleration.  As  more  acceleration  is 
applied  to  the  accelerometer,  the  assembly  will  maintain  the 
proof  mass  position  and  rebalance  current  will  increase  with 
increased  acceleration  until  the  sensor  saturation  limit  is 
reached.  An  exploded  view  of  the  actual  sensor  assembly  can 
be  seen  in  Figure  2.12. 

This  type  of  accelerometer  does  not  come  with  an 

internal  (factory  set)  load  resistor  (R  in  Figure  2.11). 

L 

Thus,  an  external  load  resistor  must  be  provided.  This  is 
desirable  since  the  ranging,  or  sensitivity,  of  the 
accelerometer  output  can  be  chosen  to  suit  specific 
applications.  The  value  of  the  external  load  resistor  is 
determined  by  the  following  formula  [7:3-6]: 

R  =  _ voltage  sensitivity  desired _ 

L 

current  sensitivity  of  the  accelerometer 

The  current  sensitivity  of  the  QA-1100  is  approximately 
1 . 3mA/g  (where  g  is  the  acceleration  due  to  gravity).  For 


this  thesis, 


the  accelerometer  is  configured  to  have  a 


substantial  degree  of  accuracy.  Nonetheless,  a  tumble  test 
can  be  performed  and  has  been  performed.  A  tumble  test 


consists  of  positioning  the  accelerometer  with  the  input 
axis  exactly  vertical,  pointing  downward  and  then  upward. 
The  sensor  will  detect  the  earth's  gravity  vector.  The  two 
measurements  (input  axis  up  and  input  axis  down,  refered  to 

as  V  )  are  then  used  in  the  following  equation: 

OUT 

V  =  V  x  Scale  factor  +  Bias 

OUT  ACT 

Here  V  is  2  volts  (since  2  volts/g  is  the  sensitivity  of 
ACT 

the  accelerometer) .  Use  of  this  equation  results  in  two 
equations  and  two  unknowns  (scale  factor  and  bias).  Pre¬ 
liminary  testing  of  the  accelerometer  has  resulted  in  a  very 
small  value  for  bias  (about  2  milivolts)  and  a  scale  factor 
of  very  near  unity.  Thus,  for  this  thesis,  the  scale  factor 
is  assumed  to  be  equal  to  one  and  the  bias  is  assumed  to  be 
zero.  This  assumption  will  be  discussed  further  in  Chapter  V 
under  Review  of  Assunptions. 

Accelerometers  cannot  distinguish  between  gravity  and 
true  acceleration.  This  fact  is  a  major  concern  in  the  GYRAC 
system  and  must  be  accounted  for.  A  special  mounting  plat¬ 
form  has  been  built  for  the  accelerometer  allowing  for 
complete  leveling.  The  accelerometer  platform  will  be 
initially  adjusted  until  a  very  near  zero  reading  is  estab¬ 
lished  from  the  accelerometer.  However,  during  movement  of 
the  GYRAC  system  it  is  highly  likely  that  errors  will  occur 
in  the  accelerometer  output  due  to  travel  over  a  non¬ 


level  surface.  This  problem  is  discussed  further  in  Chapter 


Figure  2.13.  Accelerometer  Integrator  and  Scaling  Circuit 


V  under  Review  of  Assumptions. 

The  output  from  the  accelerometer  is  connected  to  an 
integrator  circuit,  shown  in  Figure  2.13.  The  output,  which 
is  velocity,  is  scaled  such  that  one  volt  is  equal  to  one 
foot  per  second  of  velocity.  This  analog  voltage  is  then  fed 
into  an  A/D  converter  (another  AD573)  resulting  in  a  10  bit 
binary  representation  of  velocity. 

GYRAC  Computer  and  Interfacing  Subsystem. 

Up  to  this  point,  the  gyro  subsystem  and  the 
accelerometer  subsystem  have  been  discussed.  The  resulting 
output  of  these  systems  will  be  in  digital  form  as  mentioned 
earlier.  The  remaining  task  is  to  transmit  these  signals  out 
to  an  external  computer  where  they  can  be  used  for 
navigation  purposes.  This  is  accomplished  through  a  bi¬ 
directional  GYRAC  sensor  bus,  the  GYRAC  computer,  and  an  RS- 
232  interface.  The  sensor  bus  contains  eight  data  lines, 


V,'.  four  address  lines,  and  one  read/write  line.  Since  the  gyro 

and  accelerometer  data  is  all  larger  than  8  bits,  the  data 
from  each  of  these  devices  must  be  gathered  in  two  separate 
parts.  This  causes  timing  problems  since  the  S/D  and  the  A/D 
converters  constantly  update  themselves  with  the  most 
current  measurement.  This  means  that  after  a  data  signal  is 
obtained,  the  value  in  the  converter  will  change  before  the 
second  half  of  the  data  signal  can  be  transmitted. 

This  problem  was  solved  by  latching  the  data  into  a  set 
of  tri-state  latches.  These  latches  will  hold  the  data  as 
long  as  necessary,  allowing  sufficient  time  to  transmit  both 
bytes  of  the  data  signal.  See  Appendix  B  for  more  design 
detail.  Also,  since  each  data  signal  from  each  converter  is 
•  divided  into  two  parts,  a  separate  address  is  used  for  each 

part.  Thus,  six  addresses  are  needed  to  obtain  all  the  gyro 
and  accelerometer  data.  A  seventh  address  is  used  to  reset 
the  integrator  constant  to  zero  (by  discharging  the 
capacitor  over  the  op-amp).  This  reset  is  required  to  insure 
no  initial  condition  exists  on  the  integrator  and  can  be 
used  to  reset  the  integrator  periodically  when  the  GYRAC 
system  is  not  moving.  See  Appendix  B  for  detailed  design 
layout  of  address  decoding. 

All  computer  interface  devices,  the  integrator  circuit, 
the  A/D  converters,  the  accelerometer  load  resistor  circuit, 
and  a  set  of  7-segment  LED  displays  are  located  on  a  general 
purpose  wire-wrap  card.  The  LED  displays  are  used  to  read 
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the  heading  information  coming  from  the  S/D  converter  and 
display  it  in  hexideciraal  format.  This  information  is  used 
for  initial  alignment  of  the  flux  detector  and 
troubleshooting.  A  layout  of  the  wire-wrap  card  and  the  LED 
circuitry  can  be  seen  in  Appendix  B. 

The  GYRAC  computer  was  originally  a  custom  printer 
interface  card  built  for  AFIT,  but  was  modified  to  its 
present  state.  The  processor  is  a  6802  based  microprocessor 
with  Ik  of  ROM  and  128  bytes  of  RAM.  A  modification  was  made 
to  add  an  additional  2K  bytes  of  static  RAM  to  increase  the 
memory  capability.  The  new  memory  map  is  detailed  in 
Appendix  D.  The  computer  also  contains  an  asynchronous 
communication  interface  adapter  (ACIA)  which  converts  eight 
bit  parallel  data  to  RS-232  format  serial  data  and  handles 
all  handshaking  to  an  external  computer.  A  parallel 
interface  adapter  (PIA)  is  also  resident  on  the  computer 
card  which  acts  as  the  interface  between  the  GYRAC  sensor 
bus  and  the  GYRAC  computer  bus.  A  power  modification  was 
also  made  to  the  computer  to  create  its  necessary  +  and  -  12 
volts  and  -5  volts  from  the  +  and  -  15  volts  available  from 
the  gyro  base.  The  GYRAC  computer  software  is  present  in  the 
Ik  EPROM  (see  Appendix  F  for  program  listing)  allowing  the 
computer  to  receive  and  respond  to  commands  from  an  external 
computer  via  an  RS232  serial  link.  A  schematic  diagram  of 
the  GYRAC  computer  showing  the  RAM  and  power  modifications 
can  be  seen  in  Appendix  D.  Appendix  E  contains  the  edge 


connector  wiring  diagrams  for  all  the  GYRAC  system  circuit 
boards  (S/D  converter  card,  interface  card,  and  computer 
card)  showing  all  interconnecting  plugs. 

GYRAC  System  -  Theory  of  Operation 

The  purpose  of  this  section  is  to  provide  a  clear 
picture  of  how  the  GYRAC  system  functions  as  a  whole.  It  is 
intended  to  supplement  the  previous  subsystem  descriptions. 
This  discussion  begins  by  explaining  what  occurs  on  system 
power-up  and  ends  with  a  description  of  how  the  system 
responds  to  a  command  input.  The  slaving  switch  is  assumed 
to  be  placed  into  the  ’’slaved”  position  (representing  a  full 
up  configuration  of  the  GYRAC) .  The  GYRAC  must  be 
stationary  upon  power-up  to  allow  for  stabilization  of  the 
flux  detector. 

Once  power  has  been  applied  to  the  system,  the  rotor 

(spinning  mass)  in  the  gyro  begins  to  rotate.  Output  from 

the  gyro  (the  two  square  waves)  is  paused  while  the  rotor 
comes  up  to  operational  speed  (16,000  rpm).  During  this 

same  time,  a  red  HDG  flag  (compass  warning  flag  -  see  Figure 

2.4)  is  displayed  on  the  indicator  face.  This  red  flag  is  a 
visual  indication  that  the  displayed  heading  is  not  valid. 
While  the  rotor  is  coming  up  to  speed,  the  slaving  signal 
from  the  magnetic  flux  detector  is  allowed  to  pass  to  the 
indicator  providing  the  reference  signal  for  magnetic  north. 
The  compass  card  in  the  indicator  is  rotated  at  the  fast 
slaving  rate,  360  deg/min  [6],  until  the  reading  on  the 
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indicator  is  in  agreement  with  the  magnetic  flux  detector 


slaving  signal.  Once  the  rotor  has  reached  operational 
speed,  the  red  HDG  flag  is  removed  and  the  indicated  heading 
is  valid.  This  usually  occurs  about  one  to  two  minutes 
after  power-up.  Any  robot  system  using  the  GYRAC  must 
account  for  this  spin-up  and  alignment  time  (perhaps  through 
a  timed  delay  before  requesting  initial  GYRAC  data). 

The  absolute  heading  of  the  GYRAC  system  will  be 
accurately  shown  on  the  indicator  and  on  the  LED  display  in 
12  bit  hexidecimal.  Any  rotational  movement  of  the  GYRAC 
will  be  sensed  by  the  gyro  which  provides  the  signal  to  keep 
the  indicator  accurately  positioned.  In  addition,  the 
indicator  will  respond  to  deviations  from  the  flux  detector 
slaving  signal  at  the  slow  slaving  rate,  3  deg/min  [6], 
This  slow  rate  is  used  to  prevent  the  indicator  from  trying 
to  follow  an  unstable  reading  from  the  flux  detector.  The 
flux  detector  is  very  sensitive  to  movement,  so  its  output 
can  only  be  trusted  after  it  has  stabilized.  At  this  point 
(after  the  initial  alignment),  the  flux  detector  signal 
serves  primarily  to  compensate  for  gyro  errors,  such  as 
drift.  This  particular  gyro  has  proven  to  be  a  very 
accurate  and  stable  reference.  The  drift  rate  of  this  gyro 
is  less  than  0.25  deg  in  12  hours  [8].  For  this  reason,  the 
slaving  signal  from  the  flux  detector  could  be  turned  off 
(switch  to  "free  gyro"  mode)  after  initial  alignment  is 
obtained . 


After  the  heading  data  becomes  valid,  the  GYRAC  is 
ready  to  receive  a  command  input.  The  firmware  operating  in 
the  GYRAC  computer  is  continuously  checking  for  an  input. 
Once  an  input  arrives,  it  is  compared  to  a  list  of 
acceptable  commands.  An  acceptable  command  is  a  single  byte 
of  data  in  ASCII  format  representing  the  capitol  letters  A 
to  0,  see  Appendix  F  for  command  definitions.  If  it  is  a 
valid  command,  the  firmware  program  sets  the  appropriate 
address  on  the  bus  to  enable  the  requested  data  (be  it 
heading,  heading  rate,  or  velocity).  The  desired  data  is 
collected  over  the  data  bus  (one  byte  at  a  time),  converted 
to  serial  format  and  transmitted  out  via  the  RS-232 
interface.  The  RS-232  interface  is  a  simple  three  wire 
interface  consisting  of  transmit  data,  receive  data,  and 
ground.  See  Appendix  E  for  more  detail. 

It  is  important  to  note  that  the  digital  heading  output 
is  in  a  right-handed  reference  system.  That  is,  the  heading 
angle  increases  with  counter-clockwise  robot  rotation.  This 
is  backwards  from  the  visual  indicator  unit.  The  indicator 
displays  increasing  heading  angle  for  clockwise  rotation. 
Therefore,  the  digital  output  from  the  GYRAC  and  the  LED 
displayed  heading  will  not  agree  with  the  visual  indicator 
except  at  0  and  180  degrees.  The  GYRAC  digital  heading 
output  was  intentionally  made  to  conform  to  the  more 
conventional  right-handed  reference  system. 


III.  Integration  of  the  GYRAC  System  onto  MARRS- 1 


Structural 

The  entire  GYRAC  system  is  contained  in  a  new  third 
body  tier  which  has  been  added  to  the  top  of  the  existing 
MARRS- 1  physical  structure.  It  is  separated  and  supported 
from  the  lower  body  tiers  by  eight  10.0  inch  by  3/8  inch 
diameter  threaded  and  tapped  aluminum  rods.  The  all 
aluminum  third  tier  is  12  sided  and  20.5  inches  by  20.5 
inches  by  7.0  inches  high  and  contains  two  swing  down 
removable-pin  hinged  doors  to  allow  easy  access  to  internal 
components.  An  18.0  inch  U-shaped  aluminum  tower  extends 
above  the  third  tier  to  provide  support  and  f erro-magnetic 
isolation  for  the  gyro's  magnetic  flux  detector. 

In  addition,  four  aluminum  plates  were  constructed  and 
attached  to  the  first  and  second  body  tiers  locking  them 
together  into  a  single  rigid  body.  This  was  done  because 
the  original  robot  design  allows  for  separate  body  rotation 
of  the  first  and  second  tiers.  The  GYRAC  requires  a  fixed 
orientation  relative  to  the  entire  body  and  can  not  tolerate 
rotation  without  introducing  navigation  errors. 


Electrical 

The  electrical  and  mechanical  subsystems  of  the  GYRAC 
are  completely  isolated  and  independent  of  the  remainder  of 
MARRS- 1.  Power  for  the  GYRAC  is  supplied  over  an  external 


cable  and  connects  to  the  body  tier  via  a  four  pin  DIN  plug 


(see  Appendix  E  for  detailed  power  distribution).  All  gyro 
commands  and  data  are  passed  to  and  from  the  GYRAC  via  a 
standard  three  wire  RS-232  serial  interface.  Connection  is 
made  on  the  GYRAC  body  via  a  standard  RS-232  DB25  cable 
connector  (see  Appendix  E  for  pin  out  details).  These  are 
the  only  two  external  connections  required  to  operate  the 
GYRAC.  It  is  important  to  note  that  both  of  these 
connections  and  system  operation  is  independent  of  MARRS-1. 
Therefore  the  GYRAC  could  easily  be  removed  from  the  MARRS-1 
structure  and  mounted  on  a  different  platform. 

Utilization  of  the  GYRAC  system  by  MARRS-1  for 
navigation  requires  communication  between  three  different 
onboard  computers  and  a  single  external  disk  based  computer 
for  program  transmission  and  data  collection.  Figure  3. 1 
illustrates  the  required  interconnections. 

The  navigation  computer,  a  Motorola  6802  based  system 
resident  in  the  first  body  tier,  is  the  navigation  system 
control  computer.  Its  purpose  is  to  collect  sensor  data 
from  the  GYRAC  and  drive  computers,  transmit  collected  data 
to  the  external  computer,  analyze  this  data  and  decide  how 
to  move,  and  then  issue  the  appropriate  commands  to  the 
drive  computer. 

The  GYRAC  computer,  a  Motorola  6802  based  system 
contained  in  the  third  body  tier,  accepts  requests  for  data, 
formats  the  data  if  necessary,  and  then  transmits  the 


requested  data. 


The  drive  computer,  a  Motorola  6801  based  system  by 
Virtual  Devices  located  in  the  first  body  tier,  is  the  main 
robot  computer.  It  controls  all  robot  sensors  and  devices 
except  the  sonars  and  optical  encoders,  which  are  controlled 
by  the  navigation  computer  and  the  gyro  and  accelerometer 
which  are  controlled  by  the  GYRAC  computer.  This  computer 
is  able  to  respond  to  both  requests  for  data  and  commands  to 
activate  a  device.  However,  as  used  in  this  thesis,  the 
drive  computer  only  accepts  commands  to  move  the  steering 
wheel  and  start  and  stop  the  main  robot  drive  motor. 

The  external  computer,  a  Z80  based  CP/M  system  by 
Heathkit,  would  not  be  required  in  a  field  deployed 
operational  robot.  However,  as  used  in  this  thesis  for  data 
collection,  it  must  be  connected  in  order  for  the  navigation 
software  to  function  correctly. 

All  communication  between  the  four  computers  is  done 
via  standard  three  wire  RS-232  serial  data  links  at  9600 
baud.  A  cable  is  connected  between  the  navigation  computer 
Port  X  and  the  drive  computer  MENOS  port.  A  second  cable  is 
connected  between  the  navigation  computer  Port  L  and  the 
GYRAC  computer.  The  last  cable  is  connected  between  the 
navigation  computer  Port  T  and  the  external  computer.  All 
cable  connections  are  made  with  standard  RS-232  DB25 
connectors.  They  are  located  on  the  robot's  rear  lower 
panel,  except  the  GYRAC  connector  which  is  on  the  back  of 
the  third  body  tier.  Notice  that  all  inter-computer 


communication  must  go  through  the  navigation  computer. 

Port  L  of  the  navigation  computer  was  not  originally 
designed  to  support  9600  baud.  Therefore,  a  modification 
was  made  to  the  navigation  computer  board  to  allow  Port  L  to 
select  from  one  of  eight  switch  selectable  baud  rates.  It 
is  now  identical  to  the  layout  of  Ports  X  and  T  [10].  All 
ports  are  currently  set  to  9600  baud. 

In  addition,  the  DB25  connector  on  the  lower  rear  panel 
was  wired  in  parallel  to  an  existing  internal  cable  to 
provide  both  laser  barcode  communication  at  300  baud 
(original  cable)  and  GYRAC  communication  at  9600  baud  (new 
connector).  Note  that  both  functions  can  not  be  used 
simultaneously . 

Software 

The  MARRS-1  GYRAC  system  consists  of  four  different 
custom  software  programs  which  can  be  run  in  three  different 
system  configurations  to  provide  both  test  data  and  MARRS-1 
navigation. 

The  first  configuration  allows  direct  communication 
with  the  GYRAC  computer  to  allow  testing,  calibration,  and 
checkout  of  the  GYRAC  subsystem.  It  makes  use  of  the  GYRAC 
program  resident  in  read  only  memory  (ROM)  on  the  GYRAC 
computer  board.  An  RS-232  cable  must  be  connected  between 
the  GYRAC  and  the  external  computer.  The  modem  720  program 
(M72)  is  executed  on  the  external  computer  to  provide 
outside  communications  capability.  Commands  are  typed  on 


the  external  computer’s  terminal  and  the  corresponding  data 
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from  the  GYRAC  is  displayed.  See  Appendix  F  for  complete 
operating  instructions,  structure  charts,  and  program 
listings.  Note  that  not  all  data  is  displayed  since  the 
GYRAC  data  is  transmitted  in  a  raw  eight  bit  serial  format 
which  produces  occasional  non-printable  characters. 

The  second  configuration  allows  for  collection  and 
storage  of  heading,  velocity,  and  angular  velocity  data  at 
precise  0.1  second  intervals.  In  addition,  time  mark  data 
and  distance  moved  from  all  three  wheel’s  optical  shaft 
encoders  is  provided.  All  data  is  reformatted  to  printable 
hexadecimal  format  which  may  be  displayed  on  the  external 
computer’s  terminal,  saved  to  disk,  or  printed  on  the 
printer.  It  makes  use  of  the  GYRAC  monitor  program,  in  the 
GYRAC  computer,  and  the  GTEST  overlay  program,  in  the 
navigation  computer  (see  Appendix  F  and  G  for  GYRAC  and 
GTEST  program  details).  An  RS-232  cable  connection  is 
required  between  the  GYRAC  computer  and  the  navigation 
computer  Port  L  and  between  the  external  computer  and  the 
navigation  computer  Port  X.  The  M72  program  is  executed  on 
the  external  computer  to  provide  communication  with  MARRS-1 
to  send  appropriate  commands  and  receive  data.  See  Appendix 
G  for  complete  operating  instructions,  structure  charts,  and 
program  listings.  The  MBASIC  programs  CONVERT  and  POSITION 
(see  Appendix  I)  may  be  run  on  the  saved  data  to  produce  a 
data  plot. 
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The  third  configuration  demonstrates  limited  mobile 
autonomous  robot  navigation  (using  only  heading  data)  and 
collection  and  storage  of  gyro  heading  data.  The  heading 
data  is  reformatted  to  printable  hexadecimal  format  which 
may  be  displayed  on  the  external  computer's  terminal,  saved 
to  disk,  or  printed  on  the  printer.  It  makes  use  of  the 
GYRAC  monitor  program,  in  the  GYRAC  computer,  the  MARRS.NAV 
program  in  the  drive  computer,  and  the  NAV  program,  in  the 
navigation  computer.  An  RS-232  cable  connection  is  required 
between  the  GYRAC  computer  and  the  navigation  computer  Port 
L,  between  the  navigation  computer  Port  X  and  the  drive 
computer  (MENOS),  and  between  the  external  computer  and  the 
navigation  computer  Port  T.  The  M72  program  is  executed  on 
the  external  computer  to  provide  communication  with  MARRS-1 
to  send  appropriate  commands  and  receive  data.  See  Appendix 
H  for  complete  operating  instructions,  structure  charts,  and 
program  listings.  Note  that  the  NAV  and  MARRS.NAV  software 
demonstrates  a  very  simple  method  of  navigation  and  inter¬ 
computer  communication.  They  are  not  intended  to  form  the 
basis  of  a  field  application,  but  to  illustrate  gyro 


functionality. 


IV.  General  Robot  Navigation  Theory 

With  the  recent  growth  in  research  in  the  area  of 
mobile  and  autonomous  robotics,  it  is  only  a  matter  of  time 
before  a  truly  autonomous  mobile  robot  becomes  a  reality. 
This  robot  will  possess  a  navigation  system  capable  of 
gathering  and  processing  sensory  information  to  accurately 
determine  its  location.  In  addition,  the  navigation  system 
will  also  maintain  a  world  model  of  the  robots  environment, 
perform  path  planning  (determine  travel  routes  around  known 
obstructions),  and  provide  for  dynamic  obstacle  avoidance 
(method  of  surmounting  unknown  obstacles).  The  task  of  the 
navigation  system  will  be  very  complex  and  its  future 
development  is  crucial  to  the  realization  of  a  mobile 
autonomous  system. 

Two  major  aspects  of  the  robot  navigation  problem, 
world  modeling  and  path  planning,  will  be  the  topic  of  this 
chapter.  Dynamic  obstacle  avoidance  is  considered  beyond 
the  scope  of  this  thesis  and  will  not  be  covered.  First 
some  governing  assumptions  will  be  discussed.  Second,  an 
overview  of  several  popular  approaches  to  world  modeling 
will  be  presented.  Third,  a  new  world  modeling  technique 
will  be  introduced.  Finally,  this  chapter  will  conclude 
with  a  detailed  presentation  of  path  planning  based  on  this 


new  world  model. 


ASSUMPTIONS 

Since  the  world  model  is  intended  for  use  by  a  land 
based  robot  (MARRS-1  in  particular)  which  can  only  move  in 
two  dimensions,  only  a  two  dimensional  "floor  plan"  type 
world  model  will  be  considered.  Robots  that  could  extend  or 
shrink  themselves  vertically  would  constitute  a  special 
category  which  is  beyond  the  scope  of  this  paper.  For  more 
information  on  three  dimensional  modeling  and  path  planning 
see  [15].  This  section  will  also  be  concerned  only  with  a 
robot  which  can  be  modeled  in  two  dimensions  as  a  circle 
(consistent  with  the  use  of  MARRS-1).  Some  techniques  for 
treating  robots  of  other  geometries  can  be  found  in  [15]. 
Finally,  it  is  assumed  that  all  locations  on  the  world  map 
can  be  represented  directly  in  an  absolute  reference  frame. 

PAST  APPROACHES 

World  modeling  can  be  thought  of  as  providing  a 
description  (in  essence  a  map)  of  the  robots  known  operating 
environment.  This  information  must  be  expressed  in  terras 
that  the  robot  can  easily  understand  and  best  utilize. 
Virtually  all  models  to  date  represent  the  physical  world  of 
the  robot  in  two  dimensions  using  an  outline  picture  method. 
Two  approaches  have  been  used  to  describe  the  robots  world. 
One  approae’-  has  been  to  model  all  the  obstacles  in  the 
robots  world.  The  other  approach  has  been  to  model  the  free 
space  or  safe  areas  of  travel  for  the  robot.  Basically,  the 
choices  are  to  model  where  the  robot  can  or  cannot  go. 
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Figure  4.1.  Circular  approximations  of  physical  objects 
[16:24] 

Moravec  [17]  proposed  modeling  all  physical  obstacles  with 
their  enclosing  circles.  The  radii  of  the  enclosing  circles 
could  be  increased  by  a  small  amount  to  provide  a  clear  area 
of  buffer  space  surrounding  the  obstacle.  This  would  help 
prevent  collisions  between  the  robot  and  the  obstacles.  The 
primary  drawback  of  this  method  is  the  waste  of  useful  free 
space  (see  Figure  4.1). 

A  better  way  to  model  physical  objects  would  be  to  use 
straight  line  polygonal  closed  surface  approximations.  The 
lowest  order  polygon  possible  would  be  the  best  choice. 
Lozano-Perez  [15]  has  done  considerable  work  in  this  area. 


Convex 


Nonconvex 


Figure  4.2.  Polygon  approximations  to  real  world  obstacles 


He  not  only  chooses  to  model  physical  objects  as  polygons 
but  as  convex  polygons.  A  convex  polygon  is  a  polygon  with 
no  internal  angle  greater  than  180  degrees  (see  Figure  4.2). 

Given  that  all  obstacles  are  represented  as  convex 
polygons,  a  path  can  be  found  around  an  obstacle  by 
searching  for  a  path  around  the  vertices  or  corners  of  the 
polygon.  For  example,  to  go  from  point  A  to  point  B,  in 
Figure  4.3,  a  path  is  planned  going  through  each  vertice  of 
the  polygon  obstacle.  Only  the  paths  that  do  not  cross  the 
obstacle  are  considered  possible.  Either  path  1  or  2  could 
be  taken.  Both  traverse  the  outside  perimeter  of  the 
obstacle  and  result  in  the  shortest  paths  available 
Physical  objects  such  as  that  shown  in  Figure  4.2  which  are 
not  convex  in  shape  are  either  modeled  as  convex  anyway  or 
modeled  as  overlapping  convex  polygons  by  Lozano-Perez  (see 
Figure  4.4). 


Actual 

Modeled  as 

Modeled  as 

Obstacle 

Convex 

two  adjoining 

Convex  Polygons 

Figure  4.4.  Examples  of  how  an  obstacle  may  be  modeled 
using  Lozano-Perez  technique. 


For  a  circular  shaped  robot,  Lozano-Perez  proposes  a 
technique  of  displacing  the  vertices  of  an  obstacle  by  the 
radius  of  the  robot  [15:562].  Thus,  the  robot  can  be 
treated  as  a  point;  thereby,  greatly  simplifying  the  path 
finding  problem.  This  technique  is  illustrated  in  Figure 
4.5.  Notice  how  the  robot  (now  a  point)  is  made  to  pass 
through  the  extended  vertices. 

The  technique  of  Lozano-Perez  has  several  dis¬ 
advantages.  It  can  be  wastefull  of  free  space  and 
computationally  inefficient  because  physical  objects  must  be 
modeled  as  convex  polygons.  In  addition,  this  technique 
forces  the  robot  to  hug  an  obstacle  as  it  goes  around  it. 
Relatively  small  errors  in  the  world  map  or  in  the 
navigation  data  greatly  increase  the  probability  of  a 


collision. 


Direct  Path  (Obstructed) 
Indirect  Path  (Snort  est) 
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Figure  4.6a.  Monaghan's  modeling  technique  [16:47] 


search  of  the  vertices  of  an  obstacle  is  performed  to  find  a 
way  around  it.  Monaghan's  work  emphasizes  finding  the 
shortest  path  to  the  goal  point.  Thus,  a  vertice  of  an 
obstacle  is  used  as  a  "way  point"  as  shown  in  Figure  4.6a. 
However,  an  inside  corner  (resulting  from  the  use  of 
nonconvex  obstacles)  is  never  considered  as  a  way  point  (see 
Figure  4.6b).  This  technique  does  give  the  shortest  path, 
but  it  is  certainly  not  the  safest  (due  to  possible 
collision) . 

So  far,  the  obstacles  modeling  approach  to  world 
modeling  has  been  discussed.  We  have  seen  that  obstacles 
may  be  represented  by  either  their  enclosing  circle  or  a 
polygonal  approximation.  Another  approach  to  world 
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Figure  4.6b.  Inside  corners  are  not  used  as  "way  points' 
[  16:48] 


modeling  is  to  model  the  free  space  which  a  robot  may 


occupy. 


Brooks  describes  the  free  space  which  a  robot  may 


travel  as  a  network  of  cones  [16:25],  Obstacles  are  polygon 


shaped  and  the  free  space  between  the  faces  of  these 


polygons  can  be  formed  into  generalized  cones  or  "freeways" 


(see  Figure  4.7).  The  robot  is  restricted  to  travel  along 


the  center  or  "spine"  of  these  cones.  This  technique  is 


less  prone  to  collision  since  the  robot  is  required  to 


remain  at  the  centerline  of  free  space.  The  major  problem 


with  this  method,  as  pointed  out  by  Monaghan  [16:28],  is 


"the  difficulty  of  modeling  the  map  to  account  for  movement 
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Figure  4.7. 


Generalized  cones  form  freeways  between 
obstacles  [16:27] 


of  any  obstacles.  Repositioning  a  single  object  could 
involve  comparing  each  of  its  faces  with  all  those  of  every 
other  obstacle  to  recompute  the  adjacent  free  space  cones." 

Another  free  space  modeling  technique  directly  models 
the  regions  through  which  the  robot  may  travel.  This 
technique  is  attributed  to  Crowley  [16:28].  Crowley  models 
the  free  space  around  objects  through  a  series  of  convex 
polygons  (see  Figure  4.8).  It  is  important  to  note  that  any 
two  points  within  a  convex  polygon  can  be  connected  with  an 
unobstructed  line  (see  Figure  4.9).  Thus,  movement  confined 
to  within  the  borders  of  a  convex  polygon  is  guaranteed  to 
be  collision  free.  Motion  is  restricted,  however,  when  it 


is  necessary  to  travel  to  other  regions  (adjacent  convex 
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Figure  4.8.  Convex  regions  separated  by  doorways 
represent  free  space  [16:29]  . 


leure  4.9.  Any  two  nomts,  F  and  Q,  m  or  on  a 
convex  polygon  may  be  connected  by 
unobstructed  straight  line  M6:45j 


polygons).  This  can  only  be  done  through  a  defined 
"doorway”  (see  Figure  4.8).  With  this  modeling  technique, 
finding  a  path  results  in  searching  the  network  of  doorways 
and  free  spaces. 

Crowley  also  treats  the  robot  as  a  point  much  the  same 
way  Lozano-Perez  does.  However,  while  Lozano-Perez  enlarges 
obstacles  to  account  for  the  robots  size,  Crowley  shrinks 
his  free  space  by  an  amount  equal  to  the  robot  radius.  One 
problem  with  Crowley's  technique  can  be  seen  in  Figure  4.8. 
Notice  that  for  just  one  obstacle,  five  free  space  regions 
must  be  stored  into  memory.  Also,  if  an  obstacle  is  moved 
many  free  space  regions  must  be  recomputed.  Crowley’s  use 
of  doorways,  however,  is  very  appealing  and  will  be 
expounded  upon  later. 

A  NEW  TECHNIQUE 

A  brief  discussion  of  the  current  schools  of  thought 
for  modeling  a  robot's  world  has  preceded  this  section.  By 
combining  some  of  these  ideas,  a  better  method  can  be 
obtained.  Consider  the  following  approach: 

1.  Obstacles  will  be  modeled  as  polygons  (not  just 
convex) . 

2.  The  obstacles  will  be  enlarged  so  the  robot  can  be 
treated  as  a  point. 

3.  Abstract  safe  points  will  be  established  such  that 
at  least  one  safe  point  can  be  reached  from 
anywhere  in  the  robots  environment. 

This  method  is  a  combination  of  obstacle  modeling  and  free 


space  modeling  techniques.  For  example,  in  Figure  4. 10,  a 
room  is  depicted  with  two  obstacles.  Note  that  one  obstacle 


is  convex 

in  shape 

and  the  other  is 

not . 

Now, 

a  series 

of 

doorways 

can  be 

established  much 

the 

same 

way  as 

in 

Crowley ' s 

technique.  The  free 

space 

is 

divided  into 

adjoining  convex  polygons  as  in  Figure  4.11.  Then,  doorways 
are  established  between  adjacent  convex  regions.  Next,  the 
free  space  boundaries  are  removed  leaving  only  the  obstacles 
and  the  doorways  (which  are  represented  as  a  series  of 
points  -  see  Figure  4.12).  These  doorway  points  are  called 
"safe  points".  If  a  direct  path  is  obstructed,  a  search  is 
made  of  the  "safe  points"  and  indirect  paths  can  be  obtained 
as  in  shown  Figure  4.13. 

Unlike  Crowley’s  technique,  requiring  a  doorway  be  used 
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Figure  4.11.  Free  space  is  divided  into  convex  regions 
to  define  '’safe  points." 


Figure  4.1?.  Only  obstacles  and  safe  points  are  modeled 


as  passage  between  free  space  regions,  this  technique  uses 
doorways  or  safe  points  only  when  the  goal  is  obstructed  by 
an  obstacle.  Direct  passage  can  take  place  anywhere  in  the 
room  as  long  as  the  pathway  is  unobstructed. 

To  avoid  having  pathways  which  run  very  near  the  side 
of  an  obstacle,  the  free  space  boundaries  must  be  carefully 
chosen  when  establishing  safe  points.  For  example,  Figure 
4. 14  shows  again  the  way  Crowley  separates  a  room  into  free 
space  regions.  This  is  a  poor  choice  since  it  may  require 
sustained  travel  very  near  an  obstacle  or  border.  Notice 
how  the  path  to  the  goal  runs  parallel  to  the  wall.  This 
increases  the  chance  of  collision.  As  a  rule  of  thumb,  free 
space  boundaries  should  be  constructed  so  they  never  run 
parallel  to  an  obstacle  face  or  exterior  boundary.  Figure 
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Figure  4.14.  Problems  occur  if  free  space  regions  are  not 
chosen  correctly. 
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Figure  4.15.  Free  space  regions  can  be  chosen  to  minimize 
the  Drobability  of  collision. 


4.15  shows  the  same  room  only  this  time  with  different  free 
space  borders.  None  of  the  borders  are  parallel  to  an 
obstacle  face  or  exterior  boundary.  Figure  4. 15  also  shows 
the  new  path  for  the  same  starting  and  goal  points  as  in 
Figure  4.14.  Notice  how  the  path  no  longer  hugs  the  wall. 
By  using  this  rule  of  thumb,  safer  pathways  can  be  planned. 

This  new  technique  offers  several  significant 
advantages.  By  using  regular  polygons  to  model  obstacles, 
an  accurate  representation  of  the  actual  physical  object  can 
be  obtained,  wasting  little  or  no  free  space.  Treating  the 
robot  as  a  point  precludes  having  to  consider  the  volume  of 
space  occupied  by  the  robot.  Using  "safe  points"  to  plan 
paths  around  obstacles  keeps  the  robot  a  safe  distance  from 
obstructions.  Thus,  fewer  collisions  should  occur.  Above 
all,  this  method  is  simple  and  requires  minimum  computer 
memory. 

This  technique  also  has  a  few  disadvantages.  It  could 
be  argued  that  not  yielding  the  shortest  path  is  a 
disadvantage.  However,  for  a  robot  not  under  a  tight  energy 
or  time  constraint,  the  shortest  route  is  not  necessarily 
the  best.  Safety  may  be  more  important.  When  the  world 
model  becomes  very  complex,  some  other  disadvantages  appear. 
If  an  obstacle  is  moved,  several  safe  points  may  have  to  be 
recomputed.  Also,  as  the  number  of  obstacles  increases,  the 
number  of  safe  points  goes  up  almost  exponentially  resulting 
in  heavy  computational  loading. 


DETAILED  PATH  PLANNING 

World  modeling  and  path  planning  are  highly  dependent 
upon  each  other.  Path  planning  cannot  take  place  until  a 
world  model  has  been  determined  and  the  best  world  model  is 
one  that  provides  for  the  best  path  planning.  In  the 
preceding  discussion  of  world  modeling,  it  was  necessary  to 
consider  path  planning  in  a  general  sense.  For  example,  the 
robot  must  determine  if  an  obstruction  lies  in  its  direct 
path  to  the  goal.  How  does  the  robot  do  this?  How  does  the 
robot  determine  the  best  indirect  path  if  an  obstruction 
exists?  Details  of  path  planning  will  be  discussed  in  the 
following  section  which  will  answer  these  questions. 

The  world  model  is  stored  in  the  robots  memory  as  an 
ordered  list  of  points.  All  of  the  points  (X,Y)  are 
relative  to  the  same  reference  system.  Each  obstacle  is 
described  by  an  ordered  list  of  its  vertices.  Also,  the 
vertices  of  all  exterior  boundaries  are  stored  (to  the 
robot,  exterior  boundaries  are  just  more  obstacles).  Safe 
points  are  stored  as  a  separate  list  of  points.  Thus,  a 
simple  room  can  be  represented  as  in  Figure  4. 16. 

Assume  that  the  robot  is  located  at  (17,10)  and  the 
goal  is  located  at  (2,11)  as  depicted  in  Figure  4.16. 
Notice,  that  the  direct  path  to  the  goal  is  obstructed. 
This  is  obvious  to  us,  but  how  does  the  robot  know  this? 
Before  answering  this  question  lets  review  some  geometry. 
Figure  4.17  shows  a  line  segment  connecting  the  points  K  and 
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Figure  4.16.  Modeling  of  a  room  with  one  obstacle 
as  a  set  of  noints. 


Figure  4. 17.  Line  connecting  two  points  can  be  represented 
through  parametric  equations. 

L.  This  line  segment  can  be  represented  by  the  following 
parametric  equations  [16:62]: 

X  =  X  +  (X  -  X  )s 
K  L  K 

Y  =  Y  +  (Y  -  Y  )s  (1) 

IC  L  K 

Substituting  the  coordinates  of  K  and  L  into  the  parametric 
equations  results  in  the  following  expressions: 

X  =  3  +  (8  -  3)s 

Y  =  2  +  (7  -  2)s 
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Figure  4.18.  Line  connecting  two  arbitrary  points. 


Simplifying 


X  =  3  +  5s 


Y  =  2  +  5s 


(X, Y)  obtained  from  these  equations  will  always  lie  on  the 

line  segment  for  s  between  0  and  1. 

Now  consider  another  set  of  points  P  and  Q  as  shown  in 
Figure  4.18.  Let  this  line  be  represented  by  the  following 
parametric  relations 


X  =  X  +  (X  -  X  )t 
P  Q  P 


Y  =  Y  +  (Y  -  Y  )t 
P  Q  P 


if  t  lies 


where  t  is  the  parameter  in  this  case.  Again, 
between  0  and  1  then  (X,Y)  is  on  the  line  joining  P  and  Q. 
The  parametric  relations  (1)  and  (2)  can  be  used  to  develop 
a  test  which  can  determine  if  two  line  segments  intersect 
[3].  Solving  the  set  of  equations  (1)  and  (2)  simultaneously 
for  the  parameters  s  and  t  results  in  the  following 
expressions : 
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The 

parameter 

values, 

s  and 

t,  obtained 

from 

the  above 

expressions  can 

be  used 

to  determine 

if  two 

lines 

intersect . 

Two 

lines  intersect  only  if 

both  s 

and  t 

take 

on  values 

between  0  and 

1 .  This 

test  will  hereafter 

be  refered  to  as 

the  parameter  test. 

To  determine  if  an  obstacle  lies  in  the  direct  path  of 
the  robot,  the  parameter  test  is  performed.  The  robots 
location  and  the  goal  point  form  one  set  of  points  (K  and 
L).  The  vertices  (P  and  Q)  of  each  obstacle  are  then  used, 
one  pair  at  a  time,  to  determine  if  an  intersection  exists. 


All  obstacles  or  obstacle  faces  may  not  need  to  be  checked 


G  =  Goal 


K  =  Robot 


Figure  4.19  Two  safe  points  can  be  reached  through  a  direct- 
path  from  the  robots  present  position. 

for  intersections.  No  more  tests  are  needed  once  the  first 
intersection  is  found.  Of  course,  if  no  intersections  exist 
then  the  robot  has  a  clear  direct  path.  If  an  intersection 
is  found,  the  robot  must  determine  an  indirect  path. 

To  letermine  an  indirect  path  to  the  goal  point,  the 
robot  must  perform  a  search  through  all  the  safe  points  and 
determine  which  ones  he  has  direct  access  to.  The  parameter 
test  is  again  used  to  eliminate  the  safe  points  with  direct 
path  obstructions.  For  our  example  (Figure  4.19),  two  safe 


Figure  4.20.  Two  safe  point  paths  lead  to  the  goal. 


points  can  be  reached  by  a  direct  path  from  the  robots 
present  location.  From  each  of  these  reachable  safe  points, 
a  direct  path  to  the  goal  is  checked  for  obstacles  (again 
using  the  parameter  test).  If  no  direct  paths  exist,  another 
safe  point  must  be  found.  For  our  example,  this  is  not 
necessary  since  the  goal  can  be  reached  directly  from  either 
safe  point  (see  Figure  4.20).  However,  which  path  should  be 
taken? 

To  select  the  "best'*  path  among  several  possibilities. 


an  optimization  test  is  performed.  For  each  possible  path,  a 
cost  function  is  maintained.  The  optimum  path  is  the  one 
with  the  lowest  cost  value.  The  cost  function  expression  is 
as  follows: 

2  2  2 
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where  K  =  Starting  Point 
P  =  Safe  Point 
G  =  Goal 

n  =  number  of  safe  points  used 


This  cost  function  is  merely  the  sum  of  the  distances 
squared  of  each  leg  of  the  path.  Thus,  the  optimum  path  is 
the  shortest  path. 


CONCLUSION 

World  modeling  and  path  planning  represent  only  a 
portion  of  the  general  robot  navigation  problem.  However, 
their  importance  to  the  realization  of  an  autonomous  mobile 
robot  system  should  not  be  taken  lightly.  Before  a  robot  can 
begin  to  move,  it  must  have  some  knowledge  of  its 
environment  and  it  must  be  able  to  plan  out  a  collision  free 
route  through  its  environment.  This  problem  has  received  the 


recent  attention  of  several  researchers.  Some  of  the  current 


techniques  of  world  modeling  have  been  presented  along  with 
a  new  approach.  Path  planning,  under  this  new  approach, 
consists  of  finding  an  unobstructed  pathway  to  the  goal 
point.  Safe  points  are  used  only  if  a  direct  path  does  not 
exist.  The  details  of  this  path  planning  have  been  developed 
through  a  simple  example. 


V.  Testing,  Analysis ,  and  Results 


The  testing  of  the  GYRAC  system  was  divided  into  three 
primary  phases.  The  goal  of  each  of  these  phases  is  listed 
below: 


Phase 

I . 

Verify  the 
system. 

functionality 

of 

the  GYRAC 

Phase 

II. 

Determine  if 

the  data  from 

the 

GYRAC  can 

be  used  to  accurately  track  the  location 
of  the  robot  (MARRS-1)  as  it  moves  about 
the  test  area. 


Phase  III.  Demonstrate  the  capability  of  MARRS-1  to 
use  GYRAC  heading  data  to  follow  a 

programmed  heading  exercising  closed  loop 
steering  control. 


Phase  J_ 

The  primary  thrust  of  this  phase  was  to  verify  that 
every  part  of  the  GYRAC  system  operated  properly.  This 
turned  out  to  be  a  tremendous  task  consuming  a  substantial 
portion  of  the  allotted  thesis  time. 

For  Phase  I  testing,  the  GYRAC  was  connected  to  an  H89 
computer  through  an  RS-232  interface  and  interrogated  via 
M72  modem  software.  A  logic  state  analyzer,  and 
oscilloscope  (see  Appendix  L)  were  used  to  troubleshoot  the 
GYRAC  hardware,  firmware  and  verify  correct  operation  of  the 
GYRAC  computer.  Excluding  the  accelerometer  subsystem,  all 
hardware  and  software  was  eventually  verified  to  function 
exactly  as  planned.  The  accelerometer  subsystem  could  not 
be  completely  verified  until  subjected  to  motion.  However, 


under  static  test  several  problems  were  encountered. 


Output  from  the  accelerometer  integrator  circuit  was 
continually  changing.  Within  a  few  minutes  after  power-up 
of  the  GYRAC  system,  the  integrator  output  would  become 
saturated.  Operational  amplifier  (op  amp)  integrator 
circuits  of  this  type,  operating  normally,  eventually 
integrate  into  saturation  under  a  constant  input.  However, 
the  rate  at  which  the  ouput  from  the  GYRAC  integrator 
increased  was  much  faster  than  anticipated.  The  input  to 
the  integrator  (output  from  the  accelerometer)  was  not 
constant,  due  to  the  extreme  sensitivity  of  the 
accelerometer  to  movement,  but  it  was  very  small  (about 
O.lmv).  Such  a  small  input  should  not  cause  saturation  of 
the  integrator  so  rapidly.  An  identical  integrator  circuit 
was  breadboarded  for  testing. 

The  breadboarded  integrator  circuit  was  tested  without 
an  input  (zero  input  voltage)  and  within  a  few  minutes  after 
power  up  it  would  integrate  into  saturation  (just  like  the 
actual  circuit).  This  was  unexpected.  After  consulting 
with  Analog  Devices  Corporation,  it  was  discovered  that  the 
observed  drift  rate  could  be  modeled  mathematically  through 
the  following  equation: 


I 

B 


C 


where  R  =  drift  rate 

I  =  current  bias  of  operational  amplifier 
B 

C  =  capacitance  of  integrator  feedback 

It  can  be  seen  from  the  above  equation  that  in  order  to 
decrease  the  drift  rate,  it  is  necessary  to  decrease  the 
current  bias  of  the  op  amp  or  increase  the  capacitance  in 
the  circuit,  or  both.  The  AD544  op  amp  (see  Appendix  A), 
manufactured  by  Analog  Devices,  was  selected  as  a 
replacement  due  to  its  low  current  bias  of  10  picoamps. 
Also,  the  integrator  circuit  was  redesigned  to  contain  a 
higher  capacitance.  Both  a  200  microfarad  and  a  2000 
microfarad  capacitor  were  ordered.  After  obtaining  the 
capacitors,  they  were  measured  for  actual  capacitance  and 
resistors  were  chosen  to  achieve  the  appropriate  gain  for 
the  integrator  circuit.  The  2000  microfarad  capacitor  was 
selected  for  installation  into  the  GYRAC  due  to  the  very  low 
drift  rate  achieved  in  the  test  circuit  with  this  capacitor. 
The  lowest  possible  drift  rate  was  desired  since  the  input 
signal  to  the  integrator  circuit  is  also  very  small. 

After  installation  into  the  GYRAC,  the  accelerometer 
circuit  was  again  tested.  The  results  were  much  better  than 
originally  obtained.  However,  the  output  from  the 
integrator  was  erratic  and  inconsistent.  Through  a  process 
of  elimination,  another  problem  was  found.  The  active  CMOS 
switch  used  to  reset  the  integrator  (through  software)  was 
leaking  current  into  the  integrator  circuit  and  charging  the 


capacitor  thereby  causing  the  inconsistent  and  erratic 
output.  The  switch  is  presently  disconnected  from  the 
circuit  and  a  manual  reset  of  the  integrator  must  be 
performed  by  physically  shorting  across  the  capacitor. 

At  the  end  of  Phase  I  testing,  the  accelerometer 
subsystem  appeared  to  be  functioning  correctly.  The  GYRAC 
system  was  ready  for  Phase  II. 

Phase  I I 

The  objective  of  Phase  II  was  to  collect  GYRAC  heading 
and  velocity  data  while  the  GYRAC  was  under  motion  and  post 
process  the  data  to  determine  the  location  of  the  robot 
(MARRS-1)  in  the  test  area.  The  computed  location  of  the 
robot  could  then  compared  with  the  actual  location  to  test 
the  performance  of  the  GYRAC  system. 

For  this  phase  of  testing,  the  GYRAC  was  fully 
integrated  with  the  MARRS-1  test  bed.  A  memory  overlay 
program,  GTEST.A,  was  created  to  take  advantage  of  firmware 
already  operating  inside  the  NAV  computer.  Clifford  and 
Schneider  had  produced  NAV  computer  firmware  for  collecting 
data  from  the  various  optical  shaft  encoders  and  sonars 
onboard  the  MARRS-1.  [10:B-1]  The  overlay  program  replaces 
Clifford  and  Schneider  routines  for  gathering  sonar  data 
with  routines  for  gathering  GYRAC  data.  See  Appendix  G  for 
GTEST.A  structure  charts,  program  listing,  and  operating 
instructions. 

All  data  are  received  through  an  1189  computer  via  M72 
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modem  software  and  are  then  stored  on  floppy  disk.  The 
collected  data  are  in  exactly  the  same  format  as 
Clifford/Schneider  data  CIO: IV— 1 1 3  with  the  GYRAC  data  in 
place  of  the  sonar  data. 

The  raw  GYRAC  data  is  in  hexidecimal  format  so  an 
MBASIC  program  called  CONVERT  (see  Appendix  I  for  listing) 
was  created  to  convert  the  raw  data  to  integer  format.  The 
integer  data  is  then  used  in  another  MBASIC  program  called 
POSITION  (see  Appendix  I  for  listing)  which  computes  the 
position  of  the  robot  in  the  test  area  based  on  the  GYRAC 
heading  and  velocity  data  and  a  given  initial  position.  See 
Appendix  J  for  a  sample  output  from  the  POSITION  program. 
The  computed  position  is  in  terms  of  a  cartesian  coordinate 
system  centered  in  a  corner  of  the  test  area  as  shown  in 


Figure  5.1. 


The  GYRAC  is  aligned  such  that  heading  is 


referenced  to  zero  degrees  along  the  x-axis  and  increases  in 
the  counter-clockwise  direction,  right  handed  system. 

After  several  test  runs  with  consistent  but  unusual 
results,  the  accelerometer  subsystem  was  again  suspect.  The 
computed  position  of  the  robot  indicated  almost  no  movement, 
see  Figure  5.2.  The  velocity  levels  gathered  from  the  GYRAC 
were  much  too  small.  Eventually,  it  was  discovered  that  the 
integrator  circuit  was  loading  the  internal  accelerometer 
restorer  circuit  (servo),  see  Figure  2.11.  The  result  was  a 
total  changing  of  the  characteristics  of  the  accelerometer. 
The  voltage  sensitivity  of  the  accelerometer,  2  volts/g,  was 
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no  longer  valid.  A  tumble  test  of  the  accelerometer  was 

performed  with  the  accelerometer  completely  connected  to  the 

the  rest  of  the  GYRAC,  under  full  electrical  load.  The  new 

voltage  sensitivity  was  measured  to  be  0.393  volts/g  instead 

of  the  2  volts/g  desired.  This  explained  the  low  velocity 

levels.  However,  the  accuracy  of  this  newly  measured 

sensitivity  was  questionable  since  the  total  loading  effect 

of  the  integrator  circuit  could  not  be  determined.  The 

0.393volts/g  was  measured  at  the  load  resistor  R  (see 

L 

Figure  2.11).  Using  this  new  sensitivity,  further  testing 
resulted  in  computed  positions  that  were  in  error  on  the 
high  side.  The  computed  location  of  the  robot  was  always 
downrange  from  the  actual  location,  see  Figure  5.3.  This 
indicated  that  the  actual  sensitivity  of  the  accelerometer 
must  be  higher.  An  average  sensitivity  value  of  0.6volts/g 
was  obtained  by  comparing  test  runs  using  the  2v/g 
sensitivity  with  those  using  the  0.393v/g  sensitivity.  This 
0.6v/g  sensitivity  resulted  in  computed  positions  much 
closer  to  the  actual  positions  but  still  only  with  "ball 
park"  accuracy,  see  Figure  5.4.  In  addition,  the  results 
were  not  consistent,  sometimes  high  and  sometimes  low, 
almost  random.  Another  problem  had  been  around  from  the 
beginning;  the  output  from  the  integrator  (velocity)  would 
not  go  back  to  zero  after  stopping  MARRS-1.  These  problems 
indicated  a  possible  error  in  sensed  acceleration. 


Several  tests  were  performed  with  only  the 


GrRRC  COMPUTED 
POSITION  TEST  »2C 


1 

AD-A164  826  GVRO  AND  ACCELEROMETER  BASED  NAVIGATION  SVSTEK  EOS  A 
r|  NOBILE  AUTONOMOUS  RO  <U)  air  FORCE  INST  of  tech 

H  hright-patterson  afb  oh  school  of  engi 

II  UNCLASSIFIED  R  J  BLOOM  ET  AL  82  DEC  85  F/G  17/7 

2/2  ' 

NL 

i 

m 

V 

■■ 

ml 

■  _ u 

accelerometer  in  the  system.  The  integrator  circuit  was 
completely  disconnected  and  the  accelerometer  output  was 
connected  to  a  gain  circuit  which  was  connected  to  the  A/D 
converter.  Pure  acceleration  data  was  obtained  to  determine 
the  levels  of  acceleration  achieved  by  the  MARRS-1  under 
normal  movement  about  the  test  area.  These  tests  were  very 
revealing.  Figure  5.5  is  a  plot  a  acceleration  vs  time  and 
illustrates  the  random  nature  of  the  sensed  acceleration. 
It  shows  that  the  actual  acceleration  due  to  motion  sensed 
by  the  GYRAC  is  on  the  same  order  of  magnitude  as  the  sensed 
acceleration  due  to  tilt  error  (sensed  gravity).  In 
essence,  the  signal  to  noise  ratio  of  the  system  is  about 
one.  The  MARRS-1  moves  at  such  a  slow  speed  that  the  actual 
acceleration  never  gets  much  over  the  noise  level.  For 
example,  in  Figure  5.5,  it  is  not  obvious  when  the  robot 
began  movement  and  when  it  stopped.  In  Figure  5.5,  the 
robot  actually  started  forward  movement  at  2.3  seconds  and 
was  at  a  complete  stop  at  13.8  seconds.  Thus,  the 
acceleration  data  from  the  GYRAC  and  likewise  the  velocity 
data  cannot  be  relied  upon  without  some  type  of  error 
compensation  or  a  stable  platform.  The  assumption  of  a 
perfectly  smooth  and  level  surface  had  been  violated. 

Due  to  the  results  from  the  acceleration  tests,  it  was 
not  necessary  to  continue  Phase  II  testing.  The 
accelerometer  subsystem  could  never  perform  adequately 
without  major  modifications.  Therefore,  the  third  phase  of 
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testing  was  initiated  since  it  did  not  require  the  use  of 
the  accelerometer  subsystem. 

Phase  III 

The  purpose  of  Phase  III  testing  was  to  demonstrate  the 
feasibility  of  using  gyro  heading  data  for  closed  loop 
control  of  the  MARRS-1  steering  motor.  This  effort  produced 
a  navigation  program  for  the  Nav  computer  that  requests 
heading  data  from  the  GYRAC  system  and  issues  commands  to  a 
control  program  in  the  drive  computer  (see  Appendix  H  for 
listings,  structure  charts,  and  operating  instructions  for 
both  programs).  The  robot  will  rotate  in  place  until  locked 
on  the  specified  heading.  It  then  follows  the  given  heading 
correcting  for  course  errors  as  it  moves  until  manually 
stopped.  In  addition,  at  each  point  where  a  course 
correction  is  considered  the  heading  data  is  transmitted  to 
an  external  computer  for  storage  and  off  line  analysis  (see 
Appendix  K). 

Three  problems  surfaced  during  the  design  and  testing 
of  this  system.  First,  a  communication  execution  speed 
problem;  second,  a  steering  motor  response  problem;  and 
third,  a  steering  over  correction  problem. 

Implementation  of  this  system  of  navigation  routines 
required  communication  between  four  different  computers: 
the  Nav,  GYRAC,  Drive,  and  external  computers.  The  manner 
in  which  these  communication  links  and  interfaces  were 


implemented  have  a  significant  impact  on  the  navigation 
performance. 


The  link 

:  between 

the  GYRAC  and  the 

Nav 

computer  is 

an 

RS-232  line 

operating 

at  9600 

baud . 

As 

used  in 

this 

application, 

one  byte 

commands 

are 

issued  by  the 

Nav 

computer  and 

two  bytes 

of  heading 

data 

are 

returned  by 

the 

GYRAC  computer.  The  communication  programs  at  both  ends  of 
the  link  are  written  in  assembly  language  to  make  the  link 
perform  efficiently  and  quickly.  This  link  performed 
without  error  and  did  not  significantly  slow  down  the 
navigation  process. 

The  link  between  the  Nav  computer  and  the  external 
computer  is  very  similar  to  the  GYRAC-Nav  computer  link. 
It  also  performed  well  and  did  not  slow  down  the  navigation 
process. 

However,  the  link  between  the  Nav  computer  and  the 
Drive  computer,  as  implemented,  slowed  down  the  course 
correction  process.  this  resulted  in  impaired  navigation 
performance.  Once  again,  a  9600  baud  RS-232  link  was  used. 
However,  communication  over  the  link  does  not  use  single 
byte  commands  and  is  only  driven  by  assembly  language 
communication  routines  at  the  Nav  computer  end. 

To  simplify  implementation,  the  decision  was  made  to 
use  the  existing  Drive  computer  communication  interface  and 
assembly  language  control  routines  for  the  steering  and 
drive  motors.  The  Nav  computer  controls  the  operation  by 


sending  six  bytes  of  data  representing  a  jump  to  subroutine 
command  and  a  specific  memory  address  (ASCII  format). 
Execution  of  these  subroutines  by  the  Drive  computer 
controls  the  steering  and  drive  motors.  Unfortunately,  the 
Drive  computer  communications  software  interface  requires  a 
small  time  delay  between  bytes  of  data.  In  addition,  each 
Drive  computer  motor  control  subroutine  executes  a  voice 
command,  READY,  before  returning  control  of  the  system  back 
to  the  communications  routine.  These  two  unnecessary  time 
delays  limit  the  Drive  computer  to  at  most  one  command  per 
second  which  limits  the  rate  at  which  course  corrections  can 
be  made. 

The  command  communication  problem  is  further  compounded 
by  a  slow  steering  motor  response.  The  steering  motor  does 
not  move  instantly  from  one  position  to  another.  It  takes 
as  long  as  four  to  five  seconds  to  move  180  degrees.  In 
addition,  once  the  wheel  is  turned  to  the  desired  angle  it 
takes  a  finite  amount  of  time  for  this  change  to  produce  a 
measurable  course  correction.  Small  changes  in  wheel 
direction  can  produce  large  changes  in  robot  heading  if 
given  sufficient  time  for  movement,  but  the  robot  will  be 
off  course  for  this  entire  time  period. 

The  solution  used  to  alleviate  these  problems  is  time 
delay.  Time  delays  are  executed  for  each  steering  command 
to  allow  the  wheel  sufficient  time  to  move  to  the  directed 
position.  Small  time  delays  were  also  added  after  each 


course  correction  to  allow  time  for  the  wheel  direction 
change  to  take  effect. 

A  steering  over  correction  problem  occurs  when  the 
steering  wheel  is  turned  for  course  corrections.  The  Nav 
computer  is  not  able  to  straighten  the  steering  wheel  onto 
the  correct  heading  before  the  robot  has  overshot  the 
desired  course.  This  causes  the  robot  to  oscillate  around 
the  given  course  resulting  in  an  unstable  system  where  the 
overcorrections  become  increasingly  large. 

This  problem  has  several  causes.  First,  the  gyro 
heading  data  is  measured  in  increments  of  approximately 
0.088  degrees,  but  the  robot  can  not  set  a  course  to  this 
accuracy  since  the  steering  stepper  motor  moves  in  one 
degree  increments.  Therefore,  it  must  alternately  switch 
between  two  adjacent  steering  stepper  motor  settings  to 
follow  most  headings. 

Second,  due  to  irregularities  in  the  floor  and  an 
unbalanced  weight  distribution  of  the  robot  platform  over 
its  wheels,  the  robot  drifts  from  a  "straight  course"  even 
if  the  steering  wheel  is  locked  in  the  center  position. 

Third,  course  corrections  are  made  in  one  degree 
increments  each  time  the  heading  is  sampled  and  found  to 
deviate  from  the  desired  course.  If  a  large  course 
correction  must  be  made,  many  wheel  turn  commands  will  be 
issued  causing  a  sharp  wheel  angle  to  be  present  when  the 
desired  heading  is  detected.  The  wheel  can  only  be 
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straightened  by  many  more  wheel  turn  commands  in  the 
opposite  direction.  However,  during  this  time  the  robot 
will  continue  moving  in  the  wrong  direction  incurring  a 
large  overcorrection  error. 

The  overcorrection  problem  was  solved  by  defining  a 
heading  window  formed  by  dropping  the  least  significant  four 
bits  of  the  twelve  bit  heading  reading.  This  makes  the 
window  approximately  1.5  degrees  wide  with  the  desired 
heading  located  on  one  of  the  sixteen  possible  headings 
inside  the  window  (unfortunately  not  centered  in  the 
window) .  Any  heading  inside  the  window  is  defined  to  be  the 
"correct  course".  The  unstable  oscillations  are  damped  by 
moving  the  steering  wheel  to  the  center  position  (straight 
ahead)  with  a  single  command  as  soon  as  the  edge  of  the 
heading  window  is  detected.  Detected  headings  within  the 
heading  window  do  not  produce  a  course  correction,  but  allow 
the  robot  to  continue  moving  straight  ahead  (steering  wheel 
centered) . 

Additional  time  delays  have  been  provided  after  each 
course  correction  to  allow  small  steering  changes  more  time 
to  take  effect.  This  works  well  only  if  the  robot  begins 
its  movement  within  or  near  the  heading  window.  To  insure 
that  this  always  occurs,  a  rotate-robot-to-heading-window 
routine  is  executed  before  following  the  directed  heading. 
This  aligns  the  robot’s  heading  within  the  heading  window 
before  forward  motion  is  started. 


Figure  5.6  graphically  shows  the  heading  data  for  a  33 
foot  robot  run  where  the  robot's  initial  heading  was  within 
the  heading  window.  No  rotation  occurred  since  the  initial 
heading  was  88.15  degrees  which  is  inside  the  heading 
window.  The  heading  samples  are  not  evenly  distributed  in 
time,  but  occur  at  course  correction  decision  points. 
Notice  that  the  robot  still  oscillates  around  the  given 
heading,  but  the  oscillations  are  damped  making  the 
navigation  system  stable.  This  figure  also  shows  that  few 
detected  headings  are  in  the  heading  window  which  produces 
many  course  corrections  and  therefore  small  oscillations 
around  the  window. 

Figure  5.7  shows  a  33  foot  robot  run  where  the  initial 
heading  was  not  within  the  heading  window.  An  initial 
heading  of  66.53  degrees  is  not  shown  on  the  graph  since  the 
robot  rotated  without  forward  motion  to  88.15  degrees  which 
is  the  first  point  shown  in  the  figure.  Notice  that  the 
rotate  routine  aligned  the  robot's  heading  within  the 
heading  window.  Figure  5.7  also  shows  the  course  tracking 
accuracy  that  can  be  obtained  when  the  navigation  system 
"locks  on"  to  a  course  inside  the  window. 

As  in  the  previous  figure,  Figure  5.8  does  not  show  the 
initial  heading  of  112.67  degrees.  The  robot  automatically 
aligned  itself  inside  the  heading  window  by  rotating  to  a 
heading  of  87.54  degrees.  Notice  that  a  large  number  of  the 
heading  points  are  again  outside  the  window  resulting  in 
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course  oscillation. 


However 


the  oscillations  are  not  as 


severe  as  in  Figure  5.6. 

Careful  study  of  all  three  figures  indicate  large 
oscillations  occur  when  larger  wheel  angles  (from  the  center 
position)  are  used.  This  causes  frequent  course  changes  to 
be  executed  because  detected  headings  are  not  within  the 
heading  window.  However,  because  course  deviations 
oscillate  around  the  actual  course  the  mean  course  was  very 
close  to  the  desired  course.  The  worst  case  oscillations 
resulted  in  movement  of  plus  or  minus  five  inches  around  the 
desired  heading.  No  course  drift  was  observed  which  is 
supported  by  a  worst  case  final  destination  error  of  five 
inches.  Therefore,  feasibility  r  j.  gyro  based  robot 
navigation  has  been  demonstrated. 

Review  of  Assumptions 

The  purpose  of  this  section  is  to  address  the  validity 
and  impact  of  each  assumption  made  in  Chapter  I  and  Chapter 
II. 

Five  governing  assumptions  were  set  forth  in  Chapter  I. 
The  first  assumption,  concerning  local  magnetic 
disturbances,  proved  to  be  valid.  The  magnetic  flux 
detector  was  aligned  only  once  and  throughout  the  testing  of 
the  GYRAC,  consistent  heading  information  was  obtained  at 
all  points  in  the  test  area. 

The  second  assumption,  that  of  a  perfectly  smooth  and 
level  operating  surface,  was  the  nemisis  of  this  thesis.  \s 


mentioned  under  Phase  II 


testing, 


the  effect  of 


accelerometer  tilt  error  was  far  greater  than  anticipated. 
As  a  result,  the  GYRAC  velocity  data  can  not  be  used  for 
navigation. 

The  validity  of  the  remaining  three  assumptions  (a 
perfect  integrator,  constant  velocity  over  sample  period, 
and  precisely  known  sample  time),  all  dealing  with  the 
accelerometer  subsystem,  could  not  be  determined  due  to  the 
inaccuracy  in  sensed  acceleration.  The  effect  of  each  of 
these  assumptions  is  expected  to  be  small  given  an  accurate 
acceleration  measure. 

In  Chapter  II,  it  was  assumed  that  the  bias  and  scale 
factor  errors  would  be  negligible.  The  effect  of  this 
assumption  could  not  be  determined.  However,  due  to  the 
very  small  acceleration  levels  involved  with  the  movement  of 
MARRS-1,  the  bias  and  scale  factor  errors  could  have  a 
significant  impact  on  the  accuracy  of  the  sensed 
acceleration.  In  this  case,  they  would  have  to  be 

compensated  for. 

Miscelaneous 

The  gyro  base  assembly,  which  serves  as  the  power 
source  for  the  entire  GYRAC  system,  was  noticed  to  get 
extremely  warm  during  operation  of  the  GYRAC.  To  avoid 
damage  to  the  base  assembly,  a  separate  source  of  +5  volt 
power  was  instituted.  A  separate  external  power  supply  is 
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used  to  source  the  +5  volts  and  is  provided  through  the  sane 
cable  as  is  used  for  the  system  +28  volts  external  supply. 
This  modification  greatly  reduced  the  load  on  the  gyro  base 
assembly  and  corrected  the  heating  problem.  The  GYRAC  power 
panel  diagram  in  Appendix  E  has  been  updated  to  reflect  this 


change. 


I.  Summary,  Conclusions,  and  Recommendations 


Summary  and  Conclusions 

The  purpose  of  this  thesis  was  to  design  and  fabricate 
a  real  time,  point  to  point,  closed  loop,  mobile  autonomous 
robot  navigation  system  for  the  MARRS-1  robot. 
Specifically,  the  thesis  was  limited  to  three  primary  tasks. 
The  first  task  was  to  develop  the  GYRAC  system  which  would 
be  capable  of  providing  heading  and  velocity  data.  The 
second  task  was  to  integrate  the  GYRAC  onto  the  MARRS-1 
robot  for  verification  testing,  and  the  third  task  was  to 
demonstrate  autonomous  navigation  with  the  MARRS- 1/GYRAC 
system. 

Each  of  the  these  three  parts  was  completed  with  the 
last  task  being  completed  to  a  limited  extent.  The  GYRAC 
system  is  a  complete  and  functional  unit.  However,  the 
velocity  data  from  the  GYRAC  is  not  usable  for  navigation. 
As  mentioned  in  Chapter  V,  the  true  acceleration  due  to 
motion  rarely,  if  ever,  gets  above  the  tilt  error  sensed  by 
the  accelerometer.  This  results  in  an  ambiguous 
acceleration  signal  and  thus  an  inaccurate  velocity  signal. 

This  problem  has  two  major  causes;  the  acceleration 
actually  experienced  by  the  MARRS-1  as  it  travels  across  the 
floor  is  very  small  in  magnitude  and  short  in  duration;  and, 
there  is  no  error  compensation  in  the  accelerometer 
subsystem  for  gravity  induced  (tilt)  errors.  Nothing  can  be 
done  about  the  small  accelerations  experienced  by  the 


MARRS-1,  since  it  is  an  inherently  slow  moving  robot. 
Furthermore,  speeding  up  the  movement  of  MARRS-1  would  not 
solve  the  problem  since  any  flexible  robot  navigation 
system  must  be  able  to  perform  well  at  all  reasonable 
speeds.  This  means  that  to  make  the  GYRAC  a  completely 
usable  system,  a  method  of  isolating  the  accelerometer  from 
gravity  tilt  error  must  be  incorporated.  There  are  several 
methods  for  overcoming  this  tilt  error  problem.  Several  of 
these  are  presented  in  the  Recommendations  section. 

The  problems  encountered  with  the  accelerometer 
subsystem  should  not  overshadow  the  success  with  the 
remainder  of  the  GYRAC  system.  The  GYRAC  has  proven  to  be  a 
very  reliable  and  accurate  source  of  heading  data.  This 
heading  data  can  be  used  by  any  robot  system  with  an  RS-232 
serial  interface.  In  addition,  the  heading  data  available 
from  the  GYRAC  can  be  with  respect  to  any  reference 
direction  and  only  one  alignment  along  this  reference  is 
necessary.  Subsequently,  the  GYRAC  need  only  be  powered  up 
and  will  automatically  provide  accurate  heading  data  with 
respect  to  the  aligned  reference.  This  GYRAC  heading  data 
could  be  combined  with  a  separate  source  of  distance 
measurement,  such  as  wheel  optical  shaft  encoders,  to 
produce  a  viable  navigation  system.  This  could  be 
accomplished  on  the  MARRS-1  through  software  alone  and  is 
discussed  further  in  the  Recommendations  section. 

The  GYRAC  is  completely  integrated  onto  the  MARRS-1  and 


several  tests  of  the  integrated  system  have  been  completed 
verifying  the  compatibility  of  the  two  systems.  Numerous 
software  routines  were  produced  allowing  for  communication 
between  the  MARRS-1  and  the  GYRAC  and  for  data  gathering  and 
processing  purposes.  Complete  detail  of  these  programs  can 
be  found  in  Appendices  G,  H,  and  I. 

The  MARRS-1  is  not  yet  capable  of  autonomous 
navigation,  but  a  step  was  made  toward  that  goal.  The 
MARRS-1  can  follow  a  given  heading  under  self  control  of 
the  steering  stepper  motor.  MARRS-1  can  be  initially 
positioned  at  any  heading  and  under  self  control  it  will 
rotate  in  place  until  it  is  aligned  along  a  programmed 
heading,  straighten  out  the  front  wheel,  and  begin  forward 
movement  making  steering  corrections  as  it  travels  in  order 
to  maintain  its  heading.  Currently,  the  MARRS-1  will  follow 
the  programmed  heading  until  manually  stopped.  With  the 
addition  of  a  distance  measurement  to  the  control 
algorithms,  the  MARRS-1  could  be  programmed  to  move 
autonomously  about  the  test  area. 

Finally,  the  importance  of  robot  world  modelling  and 
path  planning  to  autonomous  navigation  should  not  be  taken 
lightly.  Before  a  robot  can  begin  to  move  it  must  have  some 
knowledge  of  its  surroundings  and  it  must  be  able  to  plan  out 
collision  free  and  efficient  pathways  through  its 
environment.  Some  of  the  current  techniques  of  world 
modelling  have  been  presented  along  with  a  new  approach. 


Path  planning,  under  this  new  approach  consists  of  finding 
an  unobstructed  pathway  to  the  goal  point.  Safe  points  are 
used  only  if  a  direct  path  does  not  exist.  The  details  of 
this  path  planning  have  been  developed  through  a  simple 
example. 

Recommendations 

There  was  not  time  to  accomplish  many  of  the  goals 
optimistically  set  forth  at  the  beginning  of  this  thesis 
effort.  In  addition,  throughout  the  development  of  the 
GYRAC  system  and  while  working  with  the  MARRS-1  robot,  many 
problems  were  identified  too  late  to  correct  and  many  new 
ideas  were  conceived  too  late  to  implement.  Therefore,  the 
following  recommendations  are  offered  as  possible  extensions 
of,  or  improvements  to,  this  thesis: 

1.  To  correct  the  tilt  error  problem  with  the 
accelerometer  subsystem  in  the  GYRAC,  some  type  of  error 
compensation  is  necessary.  For  example,  two  or  more 
accelerometers  could  be  added  to  the  system.  These 
accelerometers  would  be  perpendicular  to  each  other  and 
perpendicular  to  the  existing  accelerometer.  By  aligning 
one  accelerometer  along  the  vertical  and  the  other  along  the 
horizontal  (but  perpendicular  to  the  existing 
accelerometer),  a  signal  could  be  generated  which  would  be 
proportional  to  the  amount  of  tilt  experienced  by  the 
platform.  This  signal  could  be  subtracted  from  the  original 


accelerometer  signal;  thereby,  nulling  out  the  tilt  error. 
Perpendicular  accelerometer  pairs  are  commercially  available 
through  Sundstrand  Data  Control  Incorporated  and  other 
manufacturers.  In  addition,  due  to  the  small  amount  of 
acceleration  actually  experienced  by  the  MAHRS-1,  another 
single-axis  accelerometer  should  be  purchased  with  much 
greater  sensitivity.  This  accelerometer  would  replace  the 
current  QA-1100  in  the  GYRAC.  A  full  scale  range  of  plus  or 
minus  one  "g"  would  be  sufficient  (the  QA-1100  has  a  range 
of  plus  or  minus  13  "g's")  and  would  result  in  accelerometer 
readings  which  would  be  less  succeptible  to  bias  and  scale 
factor  errors.  Also,  a  new  integrator  circuit  should  be 
designed  with  a  much  higher  impedence  to  avoid  loading  the 
accelerometer  internal  servo  circuit.  This  is  necessary  so 
the  sensitivity  of  the  accelerometer  will  not  be  effected  by 
the  integrator  circuit.  The  new  integrator  circuit  must 
also  be  designed  with  drift  rate  in  mind,  as  described  in 
Chapter  V  under  Phase  I  testing. 

2.  Another  possibility  for  correcting  the  tilt  error 
problem  would  be  to  incorporate  a  displacement  gyro.  This 
gyro  could  be  used  to  sense  small  displacement  angles  of  the 
accelerometer  into  the  vertical.  This  displacement,  or 
tilt  angle,  could  be  used  to  generate  a  signal  proportional 
to  the  amount  of  accelerometer  tilt.  This  signal  could  then 
be  used  to  null  out  the  tilt  error. 


3.  The  tilt  error  problem  could  also  be  corrected  by 


using  a  stable  platform,  such  as  those  used  in  inertial 
navigation  systems  (INS),  to  mount  the  accelerometer.  Only  a 
single  axis  platform  would  be  required  to  maintain  the 
accelerometer  input  axis  in  the  horizontal  plane.  Taking 
this  suggestion  even  further,  a  complete  INS  could  be 
incorporated  on  the  MARRS-1  or  another  robot  instead  of  the 
GYRAC.  An  INS  would  provide  velocity  and  direction 
information  sufficient  for  navigation. 

4.  The  GYRAC  heading  data  could  be  combined  with 
an  external  source  of  displacement  data,  such  as  the  wheel 
shaft  encoder  data  on  MARRS-1,  to  produce  data  suitable  for 
position  determination. 

5.  Tests  need  to  be  conducted  to  compare  the  accuracy 
of  computing  the  position  of  MARRS-1  based  on  pure  wheel 
shaft  data  with  computed  position  based  on  both  GYRAC 
heading  and  wheel  shaft  data. 

6.  More  work  is  necessary  to  refine  the  control  of  the 
MARRS-1  allowing  it  to  follow  a  given  heading.  Reasonably 
accurate  navigation  was  observed  using  the  relatively  simple 
approached  outlined  in  Chapter  V.  However,  several 
improvements  can  be  made  that  should  greatly  improve 
performance . 

First,  the  drive  computer  control  programs  and 
communication  software  should  be  rewritten  in  assembly 
language  using  single  byte  ASCII  commands.  This  will 
eliminate  command  and  communication  time  delays  allowing 


faster  steering  response  (hundreds  per  second  as  opposed  to 


one  per  second).  This  would  also  allow  the  heading  window 
to  be  narrowed  which  would  help  reduce  oscillations. 

This  change  also  requires  the  command  routines  of  the 
Nav  program  to  be  changed,  but  nav.a  (see  Appendix  H)  has 
been  designed  in  a  three  level  structure  to  make  changes  and 
additions  easy.  The  bottom  level  consists  of  hardware  and 
device  dependent  routines  such  as  transmit  a  byte  of  data  to 
the  Drive  computer.  The  middle  level  of  intermediate 
routines  uses  the  lower  level  routines  to  define  function 
primitives  such  as  turn  on  drive  motor  at  high  speed.  The 
top  level  of  commands  use  the  function  primitives  to  form 
navigation  commands  such  as  rotate  until  locked  on  the 
heading  window.  Therefore,  each  level  is  independent  of  the 
way  lower  levels  are  implemented  which  limits  the  effects  of 
changes  to  within  a  module. 

Second,  more  intelligent  steering  control  routines 
should  be  developed.  They  should  anticipate  when  to  start 
straightening  out  the  front  wheel  instead  of  trying  to  do  it 
all  at  once  as  was  done  in  this  thesis.  In  addition,  they 
should  be  able  to  move  the  steering  wheel  in  increments 
proportional  to  the  amount  of  correction  needed  as  opposed 
to  single  degree  increments  per  correction.  These  additions 
will  flatten  out  the  oscillations  and  provide  better 
navigation  accuracy. 

7.  Once  an  accurate  method  of  position  determination 
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and  of  controlling  the  MARRS-1  is  verified,  the  next  step 
would  be  to  develop  the  math  routines  necessary  for  MARRS-1 
to  perform  the  onboard  processing  required  for  navigation. 
The  full  world  model  as  described  in  Chapter  IV  could  then 
be  implimented  to  provide  the  MARRS-1  with  path  planning 
capability. 
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Lieutenant  of  the  United  States  Air  Force. 

He  was  assigned  to  the  Peacekeeper  Division  of  the 
6595th  Missile  Test  Group  at  Vandenberg  AFB,  California. 
While  at  Vandenberg  AFB,  Captain  Bloom  served  as  primary 
Test  Controller  for  the  assembly,  check-out,  and  launch 
preparation  of  the  first  four  Peacekeeper  flight-test 
missiles . 

In  may  1984,  he  entered  the  Masters's  program  in 
Astronaut ical  Engineering  at  the  Air  Force  Institute  of 
Technology. 

Captain  Bloom  is  married  to  the  former  Raylene  A. 
Burgess  of  East  Ely,  Nevada.  They  have  two  children: 
Jessica  and  Brandon. 

Address:  Box  316 

Jackpot,  Nevada  89825 
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Captain  William  J.  Ramey  Jr.  was  born  December  25,  1952 
in  Great  Falls,  Montana.  He  graduated  as  class 

Valedictorian  in  1971  from  Jefferson  High  School,  Boulder, 
Montana  and  later  that  year  attended  Montana  State 
University.  He  enlisted  in  the  Air  Force  in  1974  and  became 
an  Honor  Graduate  of  the  Cryptographic  Equipment  Maintenance 
School  at  Lackland  AFB,  Texas,  where  he  was  later  assigned 
as  an  Instructor.  He  attended  San  Antonio  College  pursuing 
a  degree  in  Electrical  Engineering.  In  1977,  he  was 
selected  for  the  Airman  Education  and  Commissioning  Program 
and  attended  Texas  A&M  University  where  he  received  a 
Bachelor  of  Science  degree  in  Electrical  Engineering  in 
1979.  In  1980,  he  graduated  as  a  Distinguished  Graduate 
from  Officer  Training  School.  Upon  graduation,  he  was 
assigned  to  the  National  Security  Agency  (NSA)  as  a  Computer 
Engineer  and  was  later  certified  by  NSA  as  a  Senior 
Cryptologic  Engineer.  He  attended  the  University  of 

Maryland  pursuing  a  Masters  degree  in  Electrical 
Engineering.  In  1984,  Captain  Ramey  began  a  Masters  program 
in  Electrical  Engineering  at  the  Air  Force  Institute  of 
Technology,  Wright  Patterson  AFB,  Ohio. 

Captain  Ramey  is  married  to  the  former  Elizabeth  A. 
West  of  Farmingdale,  New  York.  They  have  three  children: 

Matthew,  Joshua,  and  Katherine. 

Address:  Box  371 

Boulder,  Montana  59632 
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ANALOG 

DEVICES 


Low  Profile 

Synchro/Resolver-to-Digital  Converter 
SDC1 700/1 702/1 704  SERIES” 


FEATURES 

Internal  Microtran«former«  for  60Hz,  400Hz  and  2.6kHz 
References 

Low  Profile  10.4  )  o 

10 , 12-  or  14-Bit  Resolution  for  360 
High  Tracking  Rates  (76  revs/secl 

Voltage  Scaling  with  External  Resutors  (Unique  Feature) 

DC  Voltage  Output  Proportional  to  Angular  Velocity 
Low  Cost 

Lightweight  3oz.  (85  grams) 

MIL  Spec/Hi  Rel  Options  Available 

APPLICATIONS 
Servo  Mechanisms 
Retransmission  Systems 
Coordinate  Conversion 
Antenna  Monitoring 
Simulation 
Industrial  Controls 
Fire  Control  Systems 
Machine  Tool  Control  Systems 

GENERAL  DESCRIPTION 

Tl.i  SDC1700.  SDC1702  and  SDC1704  arc  modular,  contin¬ 
uous  t. .eking  Synchro/ Resolver-to-Digital  Converters  which 
cmplov  a  t\  pt  2  servo  loop 

Thev  arc  intended  for  use  in  both  Industrial  and  Militate 
applications 

The  input  signals  can  tie  either  5  wire  synchro  plus  reference 
nr  4  wire  resolver  plus  reterenec.  depending  on  the  option 
The  outputs  will  be  presented  in  TTL  compatible,  parallel 
natural  binary 

One  id  the  outstanding  features  ot  the  converters  is  the  use 
of  precision  icon  1  and  reference  microtransformers  Th is 
has  made  it  possible  to  include  the  transformers  within  the 
module,  ru-n  on  the  hOHz  option  and  yet  still  maintain 
the  profile  r  of  led 

Particular  attention  has  been  paid  in  the  design,  to  achieving 
the  highest  tracking  rates  and  accelerations  possible,  com- 
pjuoic  with  the  resolution  and  earner  trequenev  used,  while 
at  the  samt  tm.c  obtaining  a  high  overall  accuracy 
Whc.',  SI>C  s  arc  used  in  control  loops,  it  is  often  useful  to 
rldLc  j  \oitagc  winch  is  proportional  to  angular  vtrloor.  Ihis 
voltage  is  available  and  has  been  brought  out  on  all  the 
SPC  1  70ii  converters 


Extended  temperature  range  version#  or  all  the  converters 
are  available. 

MODELS  AVAILABLE 

The  three  Svnchro-to-Digna!  Converters  described  in  this 
data  sheer  differ  primarily  in  the  areas  of  resolution.  a».cu> 
raev  and  dynamic  performance  as  follows 
Model  SPC1702XV2  is  a  IO-bit  converter  whim  has  ar 
oxeral!  accuracy  of  -22  arc-minutes  and  a  resolution  c»i  .1 
arc-m;nutcs 

Modei  SDC:i"OOXV7  is  d  12  bit  converter  with  an  overai1 
accuracv  ot  ±8  5  arc-minutes  and  a  resolution  oi  5.:  aTC- 
minutcs 

Model  SDC17Q4\^  Z  is  a  14-tm  converter  with  an  weraV. 
accuracv  ot  ±2.2  arc-minutes  -1LSB  and  u  resolution  ot  i  •' 
arc-minuics 

The  XYZ  code  defines  the  option  thus  <X»  signifies  the 
operating  temperature  range.  (\  '  signifies  the  rcterci.wt  tre- 
queno.  (2)  signifies  the  input  soilage  and  range,  and  whether 
it  will  accept  synchro  or  resolver  format 

More  information  about  the  option  code  is  given  under  the 
heading  of  “Ordering  information 


NOTE 

I  or  til  the  stamUrd  options,  no 
with  thev  converters 


external  transtormers  ; 


SYNCHRO  &  RE  SOI  VEP  CONVERTERS  VOL  II.  13-<*9 


*  l1  ■  ■ 


SBC  1700 

S/D  Converter 

Data  Sheet  (continued) 

SPECIFICATIONS  (typical  @  +  .’5  C  i.nlea  otherwisa  noted) 

MODELS 

sOCI7(>2 

s|>CI70«) 

snn  ’■)♦ 

\t.Vl  RACY  1  lin^ti  error* 
m)H* 

4'n)||z 

2  6kHz 

*22  arc  minutes 
’  22  arc  minutes 
"22  arc -minutes 

*  H  S  irc-minuies 
*8  5  ate  minutes 

5  arc  /ninuies 

'  2  )  arc  minuics  1 1 1  sU 
-2  1  arc  minutes  ■  1  l.sH 
*  2.9  ire  min'iics  - 1  L-*B 

RESOLLTION 

10  Kit*  t  U  SB  =  21  ify  mins) 

12  Bits  (ILSB  -53  an  mun) 

!  4  Bits  Ml  sM  ;  1  !  arc  minsi 

OLTPL1  il n  Parallel) 

10  Hits  iNitural  Bmirv • 

12  BitsiNituril  Binary) 

14  Bits  ( Natural  Bmjrv  j 

*>IGNAL  AND  REFERENCE 
FREQUENCY 

00H/.  4i)OHz.  2  okllc 

. 

SIGNAL  VOLTAGE  ( Line-to-Lme) 
Low  Loci 

Hgn  Level 

U  S  V  rms 
,loV  'ms 

SIGNAL  IMPEDANCES 

Low  Level 

Hign  Level 

2bk£2  v  Resistive) 

200kH  1  Resistive) 

REFERENCE  VOLTAGE 

Low  Level 

High  Level 

2oV  (  ll  BV  Signal) 

USV  (90V  Signal) 

INFERENCE  IMPEDANCE 

270HL2  1 1 1 5 V  Signal) 

56ki2  i26V  Reference1 
Omptjjnce  is  Resistive) 

TRANsrGKMER  ISOLATION 

?00V  .tc 

TRACKING  RATE  ‘mini 
»OHz 

400Hz  * 

2  okHt 

Accel 

Constant  Kx 

60Hz 

-iOCHz 

:  okHz 

5  Revolutions  Per  Second 

Jo  Revolutions  Per  s>econd 

75  Revolutions  Per  Second 

1  880.  sec’ 

10. <300  sec* 

513  000' «ec* 

■ 

500'  sec 

12  Revolutions  Per  Second 

25  Revolutions  Per  Second 

5  20.  sec : 

56.uOO/sec; 

170.000  sec: 

STEP  RESPONSE  (179^  Step; 

■  For  ILSB  Error) 
oOHz 

400Hz 

2.6kHz 

1  5sec 

1 25 ms 

50m* 

• 

PoWtR  LINES 

tl5V  •>  25mA  l 
•5V  •>  -OmA  f 

tl5V  5)  30mA  i 
-;v  «  S5xA  r 

POWER  DISSiPvriON 

1  ’  Watts 

\  3  W  ins 

j AT  \  LOGIC  ol:plt; 

TTL  (.  ..inpatib.’ei 

2 TTL  L^ads  'DCl’o’6N  f. 

-) TTL  Loads  S DC I" 025V  L 

:TTL  Loads  S DC l ’006  YZ 

4  1  ri.  1  .uus  SDCl 7o«)5YZ 

2TTL  L.'ids  on 

All  Onions 

B  L  6  Y  LOGIC  >ITPIT  POSITIVE 

ni’Ht 

2  M»||Z 

PI  LSE  •  l  TTL  L*.ad) 

0  ops  | 

2  <'M*  \  *; 

2  Ouj  \ 

• 

u  )Ui  1 

1  *---s :  -Jon 
i  Ja>  | 

MAX  i)  \  f  N  IR  ANSI  FR  TIME 

'•'■MG 

+IXJIG 

2  6kHz 

anus 

5  ‘  us 
l  *us 

1 5u» 

(  »us 
'1  rlys 

iNHIhir  IN  PL  T  •  r. .  Inhibit) 

L  <<«-  ’>  *  1 TL  1  .-id 

1  .  g.y  >>  :l  T1.  i  .-ad > 

W  VKM  1  P  :  »ME 

l  *Cc  to  Kited  \ v v  ,;ru. 

i  \  MPV  R  \  n  RE  HANGF. 

Dp-'ir.-*; 

'•f  r  .,-e 

•>  to  -  ’•>  '(.  Sr  ,j.,i ird 
-:t  1  •  .  .  t\u-u.lv\l 

*  •  1  r..  -)JS  1 

• 

.MVU  NSJtJNS 

•  s  :<  \  !  -»25  ’  v 

-V  E  1  *  .  t  r  •  .  .N  .  ••  t  Hi,! 

•  ■  <  T  i  S 

*■•.  iv.t.iai  viine  u  iDl.l  m: 

lif  1  iv»r  (he  jvpropnaic  •  >p*nime  tittipMittue  range  of  *he  >pmm  «iu)  Ltr 
*•  .’r\  Ifnai  m.l  amplitude  »lmtn)H  M  I’N  .  gnai  and  rrtrretK* 

1  imtnim  i>.»tiirtmn  *.  1  ‘SS  pnwrr  *ippiv  variation  *J»  •  l>)%  trunon  ■«  rrtcrmv* 

1“  Ju**'  V 

'  ’■*  ■■  ‘■fr  ifj  1  'it  t  ullfn  <a,.uiJ  tir  <ku  .1  S<  at>i<vr  •.  invf'ifii 

•' *  ."■*ar>i  ‘  *  line  “<•»  a  i.«tan.e  gttaitr  than  0 

, -<t...ri  'i.’i'f.f  .,  mnf(  *iiHi)ul  xiiii.f. 


VOL.it.  13-50  SYNCHRO  &  RESOLVER  CONVERTERS 


A-t 


'■lK 


■  "  W  *  <  W"  *  ’  at  '  J(  ”j(  *  „  ■*_  -•„  ••  .  ^  _  t 


SDC  1700  S/D  Converter  Data  Sheet  (continued) 


DATA  TRANSFER  (All  Models) 

1  he  readiness  of  the  converters  for  data  transfer  is  indicated 
by  the  state  of  the  BUSY  pin. 

The  voltage  appearing  on  the  BUSY  pm  consists  of  a  train  of 
pulses,  at  TTL  levels,  of  length  according  to  the  model  and 
option  (see  specification  table).  The  convener  is  busy  when 
the  BUSY  pin  is  at  a  TTL  “High”  level.  These  pulses  corres¬ 
pond  to  those  delivered  by  the  VCO  to  increment  or  decre¬ 
ment  the  up-down  counter  (see  schematic  diagram).  Thus 
the  pulses  will  occur  for  increasing  and  decreasing  counts. 

The  most  suitable  tune  for  transferring  data  is  when  the 
BUSY  is  at  a  logic  “Lo”  state,  and  the  times  allowable  for 
data  transfer  arc  shown  in  the  specification  Even  at  the 
maximum  speed  of  the  option,  these  times  will  be  sufficient 
to  transfer  data  before  the  next  BUSY  pulse  occurs. 


H 

BUSY  I" 


WIDTH  DEPENDS  ON  OPTION 
AND  MODEL  (SEE  SPEC) 


DISTANCE  DEPENDS 
ON  VELOCITY 


DATA 

VALID 


yv.' — 

.  /////A 


Data  Transfer  Diagram 
DATA  TRANSFER  DIAGRAM 

Taking  the  INHIBIT  to  a  logic  "Lo”  state  prevents  the  VCO 
(BUSY)  pulses  from  updating  the  up-down  counter.  How¬ 
ever.  if  applied  during  a  BUSY  pulse,  the  INHIBIT  will  not 
become  effective  until  the  end  of  the  BUSY  pulse. 

The  best  method  of  transferring  the  data  is  by  applying  the 
INHIBIT  (taking  it  to  a  logic  “Lo”  state),  waiting  for  at 
least  the  width  of  a  BUSY  pulse,  transferring  the  data  and 
releasing  the  INHIBIT. 

Note  that  sustained  application  of  the  INHIBIT  opens  the 
internal  control  loop  and  the  converter  may  rake  on  ap¬ 
preciable  time  to  recover  to  full  accuracy  when  the  loop 
is  restored. 


INTER!  ACING  WITH  A  COMPUTER 
It  is  recommended  that  external  latches  are  used  n*  enable 
data  to  be  transferred  onto  a  computer  data  bus.  One  method 
is  shown  in  the  diagram.  Using  this  method  will  mean  that  the 
latches  are  constantly  updated  by  the  BUSY  signal,  while  a: 
the  same  time  enabling  inputs  to  be  made  to  the  computer 
by  means  of  normal  data  transfer  procedures.  The  AC  175  5 
mounting  card  contains  these  external  components. 


L*TCHi‘ 


Suggested  External  Computer  Interface  Circuitry 
THEORY  OF  OPERATION 

If  the  unit  is  a  Svnchro-to-Digital  Convener,  then  the  3  wne 
synchro  output  will  be  connected  to  SI.  S2  and  S3  on  the 
module  and  the  Scort  T  transformer  pair  well  convert  these 
signals  into  resolver  format, 
i.c.,  V,  =  K  Eq  Sin  cot  Sin  d 

V:  -  K  Sin  cot  Cos  6 

Where  6  is  the  angic  of  the  Synchro  Shaft 

If  the  unit  is  a  Rcsolver-tw-Digital  Convener,  then  the  4  wire 
resolver  output  will  be  connected  to  Si,  S2,  S3  and  S4  on 
the  module  and  the  microtranslormer  will  act  purei\  as  an 
isolator 

To  understand  the  conversion  process,  then  assume  that  the 
current  word  state  of  the  up-down  counter  i.\  0 
The  V,  is  multiplied  by  Cos  0  and  V.  is  multiplied  b\  Sin  C 
to  give 

K  Lq  Sin  cot  Sin  6  Cos  C 
and  K  L0  Sin  cot  Cos  0  Sin  c 


DIGITAL 
OUTPUT  WORD 

Functional  Diagram  of  the  SDC1 700/2/4  Converters 
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These  Mgnais  are  subtracted  by  rhe  error  implil’icr  to  give 
K.  tjj  Sin  u. t  1  Sm  tf  Cos  0  •  Cos  0  Sin 
or  K  Sm  ujt  Sin  (0  $) 

A  phase  sensitive  detector,  integrator  and  Voltage  Controlled 
Oscillator  (VCO)  torm  a  dosed  loop  sv  stem  which  seeks  to 
nud  Sm  id  s>) 

When  this  is  accomplished,  the  word  state  of  the  up-down 
counter  ($).  equals  within  the  rated  accuracy  of  the  con¬ 
verter.  the  synchro  shaft  angle  0 

CONNECTING  THE  CONVERTER 

The  electrical  connections  to  the  converter  arc  straightfor¬ 
ward.  The  power  lines,  which  must  not  be  reversed,  ire  tl5V 
and  5V  They  must  be  connected  to  the  “il5V“  ind  “5V" 
pins  with  the  common  connection  to  the  ground  pin  GND. 

It  is  suggested  that  Q.l/iF  and  o.8pF  capacitors  be  placed  in 
parallel  from  +I5V  to  GND.  from  -15V  to  GND  and  from 
♦  5V  to  GND. 

The  digital  output  is  taken  from  pins: 

I  through  to  10  for  the  SDC1702 
1  through  to  12  for  the  SDC  1700 
l  through  to  14  for  the  SDC1704 

Pin  l  represents  ehe  MSB  in  each  case.  The  rererence  con¬ 
nections  are  made  to  pins  “RH|”  and  "Rlq”. 

In  the  case  of  a  Synchro,  the  signals  are  connected  to  "SI”, 
"S2”  and  ‘Si”  according  to  the  following  convention: 

ksi  -  S3  s  ERLO  -  RHI  Sin  tJt  Sm  ^ 

E^j  _  S2  =  FRLO  RHI  ^‘n  wt  ^  ^ 

FS2  -  SI  *  ERLO  -  RHI  Sin  wl  Sin  *  240"> 
For  1  resoiver,  the  signals  are  connected  to  "Si”.  "S2", 

"S3"  and  "S4"  according  to  the  following  convention: 

FS1  -  S3  5  FRLO  -  RHI  Sm  cjC  S,n  & 

^S2  -  S4  "  ERHI  -  RLO  ^,n  CJt  ^ 

The  lnalog  voltage  representing  velocity  is  available  between 
”VEL”  and  "GND". 

The  "BUSY"  ind  "INHIBIT"  pin  (if  used),  should  be  con¬ 
nected  as  described  under  the  heading  “Data  Transfer  * 

NOTE.  If  the  INHIBIT  pin  is  used  (i.e..  driven  to  0  volts), 
the  control  loop  will  be  opened  ind  a  finite  time  will  be 
required  (see  spec)  for  rhe  converter  to  recover. 

OUTLINE  DIMENSIONS  AND 
PIN  CONNECTION  DIAGRAM 
Dimensions  ore  shown  in  inches  and  (mm). 


MATING  SOCKET  GAMMON  450-HHH-OI -OJ 
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RESISTIVE  SCALING  OF  INPUTS 

\  unique  tenure  <>t  the  SDL  1700  series  it  ionverrers  iv  ;ti*c 
the  inputs  can  be  resistivelv  scaled  to  accommodate  am  r*r.gc 
of  input  signal  and  reference  voltages 

This  means  that  a  standard  converter  can  be  used  with  1 
personality  card  in  systems  where  a  wide  range  of  input  and 
reference  voltages  are  encountered.  In  addition  it  should  be 
noted  that  a  400liz  unit  will  operate  from  a  2  6kHz  reference 
It  will  however  have  the  velocity  and  acceleration  character¬ 
istics  as  specified  for  the  400Hz  converter.  A  60Hz  converter 
will  operate  from  a  400Hz  reference  ind  will  have  the  veloc¬ 
ity  and  acceleration  characteristics  as  specified  for  rhe  60Hz 
converter. 

To  calculate  the  values  of  the  external  scaling  resistors  for  a 
synchro  converter,  add  1. 1  lkii  in  series  with  Si .  S2  and  S3 
per  extra  volt  in  the  case  of  rhe  signal,  and  2.2kfi  .n  rhe  case 
of  the  reference.  In  the  case  of  a  resolver  converter  add 
2.22k&  per  extra  volt  in  series  with  S 1  and  S2  tor  rhe  signal 
and  2. 2kI2  per  extra  volt  in  series  with  R^j  ror  the  reference. 
For  example,  assume  that  we  have  an  1 1  8  volt  line  to  l.ne 
signal/26.0  volt  reference  converter,  and  we  wish  to  use  a 
60  volt  line  to  iine  signal  with  a  11 5  volt  reference 

Thus  in  each  signal  input  line,  the  extra  voltage  capability 
required  is: 

60  *  11.8  »  48.2  volts 

Therefore  each  resistor  needs  to  have  a  value  of  48.2  x 
1.11*  53.5kft.  In  the  case  of  the  reference,  the  extra  volt¬ 
age  capability  required  is: 

115  -  26.0  *  89  volts 

Therefore  the  resistor  needs  to  have  a  value  of 
89.0  x  2.2  =*  I95.8kft 

Thus  the  inputs  can  be  scaled  as  in  the  diagram  below 


VOTE 

*  CASE  OF  A1  AND  »S  THE  RAT-0  fR*P«S 
SfnvffN  THt  RESISTANCES  S  MO*6  jMRCRTANT 
'“*N  IH6  ABSOLUT!  RESISTANCE  VALUES 

N  GENERAL  A  1%  RAT'O  ERROR  RflLL  OIVE  RISC 
"5  EKT«A  INACCURACY  OE  17  ARC  MINUTES 
RH'LE  A  RATIO  cRROR  OF  J  NILL  -ilVt  AiS* 

TO  AN  EXTRA  -^ACCURACY  OF  1  7  ARC  MINUTES 

THE  AftSOlU’E  VALUE  OF  R,  S  NOT  CRITICAL 


BIT  WEIGHT  TABLE 


Hit  Number 

|  Wrjghr  in  Defers 

t  ■ MSB) 

1  M)  U«HH) 

2 

m  noon 

I 

*5  *  non 

X 

22  5'mh) 

s 

1  l  2MiO 

s 

>  o2sn 

2  8  |  2  5 

A  I 

1  ti 'ft? 

> 

.)  -HM 

’.«»  <1.MI  f..r  l  :«)>i  1 

■  1  1  S  I  ft 

1  1 

O 

1  2  L:>B  t.'f  M)<;i  ’"»»)  i 

<1  i-HTO 

l  I 

•  1  t-a  W 

S  *  >  i  SB  r.ir  MM  l  ~04> 
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VELOCITY  PIN 

This  p»n  provide*  a  voltaic  output  which  is  proportional  to 
the  angular  velocity  of  the  input.  The  voltage  goes  negative 
for  an  increasing  digital  angle  ami  goes  positive  for  a  de¬ 
creasing  digital  angle. 

The  characteristics  of  the  velocity  pin  output  are  given  in 
the  tabic  below 


Sculinfr  of  Output  V  oliift 
for  Onr  htttt  mi*  Vf««  it* 

2V'olt»  iSominah 

Output  Voltage  temp  Coot 

0  CSV  '  C  of 

Output 

Output  V  oiu|f  Drill  *  Ait  Modem 

o  •  roJ( 
s5oMy  '  c: 

-SS't  to  *IQS*C 
riOWiV  \ 

Line  ants 

t»-HC  to  WKl'/arr  SDC1704 
40OHi  IS 

0  *ec  to  100“  'vet  SDC  1704 
60H/  1% 

0  *v  iv  SUo'/ttt  SDC) 70o'2 
MX) H/  2% 

»*»ei  to  100  t€K  SIX  1700  2 
ftt'Hr  1  JS 

Notac  <0  to  2 t)H/ 1 

*4  1600  tec  S(K'.  1700 -'2/4 
4O0H/  2 mV  nrn 

W21MI'  >%ec  SDCI  'OO-lf* 

60Hi  2m V  rim 

1m  pedant  <•  tOuipuo 

in 

m**  Current  Available 

1mA 

The  velocity  voltage  can  be  used  in  closed  loop  servo  systems 
for  stabilization  instead  of  a  tachometer. 

The  SDC1  700/2^4  velocity  outputs  do  not  have  the  disad¬ 
vantages  of  being  inefficient  at  low  speeds  and  do  not  need 
gearing  required  by  tachometers.  In  addition,  the  output  is 
available  at  no  extra  cost 

For  other  velocity  output  scaling  and  linearity  consult  the 

factory 

Twu  examples  ot  the  use  of  the  velocity  pin  are  shown  in 
the  diagram  below 


0»M4*Ot0  VltOCtl* 


Diagram  showing  a  velocity  feed  forward  application  The 
SDC  is  used  to  produce  the  demanded  velocity  from  Synchro 
form  inputs 


TO  vO*0 


Diagram  showing  the  velocity  voltage  hemg  used  to  stabilize 
an  electro  mechanical  control  loop 


APPLICATIONS  OF  SYNCHRO*!  O-UIGIl  AL 
CONVERTERS 

SDCs  can  be  used  in  a  Variety  of  ways  in  control  loops  as 
well  as  for  the  conversion  of  angular  data  into  a  form  whith 
is  readily  acceptable  to  digital  displays  or  computers 

The  diagram  below  shows  an  SDC  being  used  in  a  digital!) 
controlled  feedback  loop 


MtuDOu 

DtWUl  M4.it 


An  SDC  Being  Used  in  a  Digitally  Controlled 
Feedback  Loop 

Such  loops  as  shown  in  the  diagram  above  require  the  high 
dynamic  performance  of  the  SDC  1700  senes  converters.  It 
should  be  noted  that  m  this  application,  the  SDC  1700  senes 
will  replace  conventional  tachometers  and  phase  sensitise 
detectors  while  at  the  same  time  provide  digital  position 
feedback. 

Many  synchro  systems  employ  a  two  speed,  geared  arrange¬ 
ment  utilizing  one  synchro  for  the  fine  shaft  and  one  for  the 
coarse  An  example  ot  this  type  is  shown  below 

Ml 


1 - T 

•*  '  ■*  * 


Diagram  Showing  Coarse  A  me  Syncnro  Processor 
System 

In  the  above  example,  two  tracking  SIM  s  are  being  used  to 
provide  data  tor  coarse'tine  (two  speeui  dai«t  transmission 
s\  stems 

The  TSL.  1012  is  a  processor  which  combines  the  outputs  ot 
rwo  SDC’s  to  provide  one  output  woro  of  up  to  19  bits  in 
length 

The  TSL1612  is  available  tor  an\  ratio  between  2  1  and  I 
and  provides  automatic  compensation  lor  misalignment  ot  the 
coarse  synchro  relative  to  its  snatt  It  also  currecis  lot  a:o 
overlap  between  the  digits  ot  rhr  rnarsr  and  tint  shaft- 
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SDC  1700  3/D  Converter  Data  Sheet  (continued) 


MEAN  TIME  BETWEEN  FAILURES  (M.T.B.F.) 

The  estimated  mein  time  between  failures  is  given  js  follows.- 

SDC  l TOO/ 2  174.000  Hours 

SDC  1704  167.000  Hours 

Further  information  relating  to  M.T  B.F.  and  to  the  quality 
control  and  tesr  procedures  employed  by  us  can  be  obtained 
from  the  factory  on  request. 

TRANSFER  FUNCTION 

The  transfer  function  of  the  SDC  1700/2  and  SDC  1704, 
400Hz  versions,  is  given  below. 

For  the  transfer  functions  of  the  other  models  or  for  a  de¬ 
tailed  analysis  of  those  given  here,  please  contact  us. 
SDC1700/2  4001 iz 

&0_  __  _ 8.8  X  to’  a  -o  8X  IQ'S) _ 

91  s3  +  8.04  X  102s2  ♦  6. 1  X  loU  ♦  8.8  X  10’ 

SDCP04  400Hz 

(?0  2.95  X  10’ (1  *8.2  X  llT3s> 

9 1  s3  *  8.05  X  U)2  i2  +  1.95  X  10ss-2.95X  lcT 

CARD  MOUNTING 

All  the  converters  can  be  mounted  on  an  r\C175  5  mounting 
card.  This  card  contains  the  latches  described  under  the  “Data 
Transfer  '  heading,  which  are  necessary  to  transfer  the  data  on 
to  a  computer  bus  system,  and  sockets  for  the  convener. 

The  latches  have  a  m -state  ourput  to  facilitate  ease  of  use. 

The  AC1755  also  contains  facilities  tor  the  inclusion  of  in¬ 
put  signal  and  reference  scaling  resistors  as  described  under 
the  heading  'Resistive  Scaling  of  Inputs" 

The  card  uses  a  22/22  0.156”  pitch  edge  connector.  The  pin 
out  is  shown  below,  (f  it  is  not  required  to  use  the  external 
latches,  they  can  be  jumpered  on  the  board. 

40 733  MOUNTING  CARD 
Di  men  non*  shown  in  inches  and  (mm) 


F  rst  Angle 
Protection 


EDGE  CONNECTIONS  ACI755 


'  !*•**  *  t/m  fm 


'  MlglT  •  •  •  \ 


ORDERING  INFORMATION 

Parts  xhouid  be  ordered  by  the  ippmprtare  part  number  n  e  , 


SD<  11700,  SOU1  702,  SIX!  1704)  followed  bv  (he  ippropriatc 
YYZ  option  code. 

If  the  unit  is  to  be  a  Resolver-to-Digiral  Converter,  the  SDC 
should  be  replaced  by  RDC  in  the  part  number. 

The  XYZ  options  are  as  tollows; 

X  signifies  the  operating  temperature  nnge  and  the  options 
are; 

X  3  5  signifies  0  to  *70  C  (commercial)  temperature. 

X  =»  6  signifies  -55°C  to  *105°C  (extended)  temperature. 

Y  signifies  the  reference  frequency  and  the  options  are: 

Y  =  1  signifies  400Hz 

Y  =  2  signifies  60Hz  # 

Y  =  4  signifies  2.6kHz 

l  signifies  the  input  signal  and  reference  voltages  and 
whether  the  converter  is  an  SDC  or  an  RDC.  The  options  are 

Z  -  1  signifies  synchro,  signal  11.8V  rms.  reference  26V  rms 
Z  »  2  signifies  svnehro.  signal  90V  rms,  reference  1 15V'  rms 
Z  =  3  signifies  resolver,  signal  1 1.8V  rms.  reference  1 1.8V  rms 
Z  -  4  signifies  resolver,  signal  26V  rms,  reference  26V'  rms 
Z  *  8  signifies  resolver,  signal  1 1.8V  rms.  reference  26V'  rms 

Thus,  for  example,  an  SDC  1704  with  a  commercial  '0  to 
♦70  C)  operating  range,  usit.g  a  400Hz,  26V'  reference  with 
an  11.8V  signal  would  be  ordered  as  an  SDC  17045  11 

For  other  than  these  opnons.  consult  the  factory 
CAUTIONS 

Do  not  reverse  the  power  supplies. 

Do  not  connect  signal  and/or  reference  inputs  to  other  rhan 
SI.  S2.  S3.  $4,  Rtu  or  RLO 

Do  not  connect  signals  and/or  references  to  a  lower  voltage 
nted  converter.  (Such  as  a  115V  Svnehro  into  a  26V  Con¬ 
verter) 

^disconnections  as  per  the  above  will  damage  'he  units  and 
void  the  warranty. 

OTHER  PRODUCTS 

The  SDC  1700/ 2'4  converters  are  just  a  few  -t  the  modules 
and  instruments  concerned  with  Sv  nehro  and  Resolver  con¬ 
version  manufactured  bv  us. 

Other  products  ire  listed  beiow  and  technical  dan  a  avail¬ 
able.  If  you  have  any  questions  ibout  our  products  or 
require  advice  about  'he  use  >f  'hem  for  1  particular  ipplsca- 
non.  please  conraer  our  Aopiicanons  Engineering  Department. 

TWO  SPEED  PROCESSORS 

Which  utilize  the  digital  outputs  of  two  SDCs  .n  1  2  ^peed 
coarse/fine  svstem  to  produce  one  combined  digital  word  of 
up  to  bits  m  length.  The  TSL  16  1  2  -.n  particular  s  available 
r or  any  ratio  between  2  1  and  (6  I 

DIGIT  ALTO-SYNCHRO  CONVERTERS 

Resolutions  >T  between  10  ind  14  bits  are  nailable 

BCD  OUTPUT  SYNCHRO  TO  DIGITAL  CONVERTERS 
The  ^BCD 1  752  and  SBCDl"??  *re  •  n.werers  wrh  1  BCD 
instead  >f  1  bm.irv  -nitput  hived  upon  'be  *'DCir>o  They 
have  lutputs  "t  *'.80  0  iegrees  .nd  <'  'o  >no  o  degrees 
respectively 

* *01(4  QT.ern.iQQ 

I- or  V’Mi  -iperatoin.  4  nOlfr  onvrrter  on  he  .sea  *tth  no 
rf'lucnnn  m  i*  curacy 
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AD573  A/D  Converter  Data  Sheet 


□  ANALOG  Fast,  Complete  10-Bit  A/D  Converter 
DEVICES  with  Microprocessor  Interface 


FEATURES 

Complete  10-Bit  A/D  Converter  with  Reference,  Clock 
and  Comparator 

Full  8-  or  16-Bit  Microprocessor  Bus  Interface 
Fast  Successive  Approximation  Conversion  -  20 ps 
typ 

No  Missing  Codes  Over  Temperature 
Operates  on  +SV  and  -12V  to  -15V  Supplies 
Low  Cost  Monolithic  Construction 


PRODUCT  DESCRIPTION 

The  AD573  is  a  complete  10-bit  successive  approximation  analog 
to  digital  converter  consisting  of  a  DAC,  voltage  reference, 
dock,  comparator,  successive  approximation  register  SAR)  and 
3  state  output  buffers-all  fabricated  on  a  single  chip.  No  external 
components  are  required  to  perform  a  full  accuracy  10-bit  con¬ 
version  in  20us 

The  AD573  incorporates  the  most  advanced  integrated  circuit 
design  and  processing  technology  available  today.  The  successive 
approximation  Junction  is  implemented  with  I:L  ^integrated 
mrccuon  logic  Laser  trimming  of  the  high  stabilitv  SiCr  thin 
film  resistor  ladder  network  at  the  wafer  stage  LWT  insures 
high  accuracy,  which  is  maintained  with  a  temperature  compen¬ 
sated  sub-surface  Zener  reference. 

Operating  on  supplies  of  -  5V  and  -  12V  to  -  15V,  the  AD573 
will  accept  analog  inputs  of  0  to  -  10V  or  -  5V  to  -  5V.  The 
trailing  edge  of  a  positive  pulse  on  the  CONVERT  line  inmates 
the  20us  conversion  cycle.  DATA  READY  indicates  completion 
o!  the  conversion  HIGH  BYTE  ENABLE  HBE'  and  LOW 
BYTE  ENABLE  LBE  control  the  8-bii  and  2-bit  three  state 
output  buffers. 

The  AD57?  is,  available  in  two  versions  for  the  0  to  ♦  70  C 
temperature  ramte,  the  AD5~3J  and  AD573K  The  AD57JS 
guarantees  r  1LSB  relative  accuracy  and  no  missing  codes  from 
-  5'  C  to  -  125  C 


AD573 


AD573  FUNCTIONAL  BLOCK  DIAGRAM 


Two  package  configurations  are  offered.  All  versions  are  also 

offered  in  a  20-pin  hermeucallv  seaied  ceramic  DIP.  The  AD5"3J 

and  AD573K  arc  also  available  in  a  20*pin  plasuc  DIP 

PRODUCT  HIGHLIGHTS 

1.  The  AD573  is  a  complete  10-bn  A  D  converter.  No  external 
components  are  required  to  pertorm  a  conversion 

2.  The  AD573  interfaces  to  many  popular  microprocessors 
without  external  butters  or  peripheral  interlace  adapters  The 
Hi  bus  of  output  data  can  be  read  as  a  10-bit  word  or  as  8- 
and  2-ba  words. 

3.  The  device  offers  true  10-bit  accuracy  and  exhibits  no  missing 
codes  over  us  entire  operating  temperature  range 

4  The  AD573  adapts  to  cither  unipolar  0  to  -  10V  or  bipolar 

-  5V  to  -  5V  analog  inputs  hv  simply  grounding  or  opening 
a  single  pin. 

5  Prrltirmance  i'*  guaranteed  with  *  5V  and  -  12V  or  -  15V 
supplies 


•Protected  hy  L.S  Patent  Nos  3.940 760,  4.213.M6,  4.136, MV 
4.400,6hV.  and  4.400,690 
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AD573  A/D  Converter  Data  Sheet  (continued) 


cprrtjrip  »TinMC  =  +  5Y.  »-  *-•»  or  -  15V,  ad  wtojw  measured  with  rasped  to  digital  common, 

OrLuIrlUnl  lUnO  milass  amerwtsa  indicated) 


RKLA  llv  t  ACCURACY 


ULL  St.AIJ: (-ALISRA  lION 


(BSSBEBSBS3 


DIPOLAR  OFFSET 


LHFFFREN  HAL  NON  LIN  EAR!  IY 


\D573J 

Mia 

Typ  Mm 

AD571K 

AD573S 

Mi* 

Typ  Mai 

Mid 

Typ  Mai 

Units 

l  EMPtRATL  RE  COEFFICIENTS 
J-'.moui  Offset 
Biputar  Otlset 
Fuji  S^aie(^ibra(ion: 


PO'X’ER  St  PPL  Y  REJECTION 
Positive  Supply 


\SAL»Xi  INPUT  IMPEDANCE 


>L  rPUT CODING 

l  A  i  pour 


D'liicul  rPUT 
1  'O'put  Sir.kt'.jrrent 
V.  .1  r  0  *V  max.  t 
Output  Source  Uurrtnt3 

V.  'i  r  ;  •  *V  mas,  T 
• >  it  put  Leakage 


k  ,;i;  i  s  pi  "i 
nput  Current 


ON  VERSION  TIME 


PF.RAJINM.L'RRLN  T 


0 

-  10 

-5 

..  5 

Positive  t  rue  Binary 


0 

*  10 

-  s 

►  5 

V2 

0  5 

c40 

clOt 

1  0 

0.8 

11 

<0 

*■  4.5 

5  0 

s-7  0 

-  11.4 

,5 

-10.5 

Positive  True  Binary 
Positive  T  rue  Offset  Binarv 


15 

25 

l 

15 

Positive  True  Binary 
Positive  True  Offset  Binary 


*■4.5 

►  *  0 

4-7  0 

1-114 

15 

-  16.5 

mA 

tM  wA 


15 

25 

•) 

15 

N«  >  TFS 

Pr'j'ive  Wcuracy  is  defined  *i  'he  le  via  non  »l  'he  itie  tranution  r^'ints  'roro  he  ideal  transfer  point  on  a 
•’raigM  me  tr  m  'he  zero  to  he  -Hit  «».a;e  *1  he  levice 

lr  .11  «iie  .atibfa:um  >s  guaranteed  nminjhe  to  -ero  with  an  external  <0(1  potentiometer  m  piace  >1  'he  IMI 
*«J  resume 

>  :t  -j-e  is  defined  si  i0  *"ifl  min-i*  if.sB,  >r  v  <*a)  volts 
•-!;ned  ii  —  «'iuM»n  t  >f  vr.ich  no  Timing  codes  will  occur 

■'  ',arg*  tfii  -  Ml  value  'mm  »P  C*  ■•»  r„„,  it  T„„  _ _ _ 

TV  :iu  out  rut  ones  have  Ktive  mil-  .pi  »  vuiti*  0  'mA  The  DATA  READY  me  n  open  collector  with 

<  n.imnjl  *> it 1 1  .nternaj  pull-up  testator 

v>rt  '-evtion  i‘*  1 *  *f  package  ■uv.ne  information 

>(Kiific«Wiu  turned  ■  •  -ange  without  mitKt 

pec  it  i«.  Minna  shown  n  hnMiace  are  tested  .,n  all  production  units  it  final 
levtficat  rst  Results  from  'hose  *nts  are  used  to  akulatc  outgoing  gualiry 
even  Ml  mm  uid  ru  s  peculation  a  are  guaranteed,  although  mlv  ;hna* 
hown  m  tv.idfive  ire  'ested  on  all  production  units. 
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AD573  A/D  Converter  Data  ..Aeet  (continued) 


FUNCTIONAL  DESCRIPTION 

A  block  diagram  of  the  ADS" 5  is  shown  in  Ensure  i.  The  positive 
CONVERT  pulse  must  be  at  least  5i)0ns  wide.  DR  goes  high 
within  l . 5 jxs  alter  the  leading  edge  ot  the  convert  pulse  indicating 
that  :hc  internal  logic  has  been  reset.  The  negative  edge  of  the 
l.ONVF.RT  pulse  initiates  the  conversion.  The  internal  10-bit 
,  ;rrent  output  DAC  is  sequenced  bv  the  integrated  inicuion 
logic  I'L'.  successive  approximation  register  ,SAR)  from  us 
most  significant  bit  to  least  significant  bit  to  provide  an  output 
current  which  accurately  balances  the  input  signal  current  through 
the  5x1 1  resistor.  The  comparator  determines  whether  ihe  addition 
•  l  each  successively  weighted  bit  current  causes  the  DAC  .urrent 
'um  to  be  greater  or  less  than  the  input  current,  :f  *he  sum  is 
more,  the  bit  .s  turned  otf.  Alter  testing  ail  bits,  the  SAR  contains 
a  li?-bu  binarv  code  whivh  accurately  represents  the  input  signal 
:o  within  LbB  0  05%  of  tuil  s*.aie!. 

The  sAR  drives  DR  low  io  indicate  that  the  conversion  is  complete 
ind  mat  the  data  :s  available  to  the  output  Sutlers  HBE  and 
UBE  -an  then  ue  activated  to  enable  the  upper  S-bu  and  lower 
1  rut  butters  as  desired.  HBE  and  L3E  mould  be  Drought  high 
prior  to  the  next  conversion  to  pijce  the  output  butlers  ;n  the 
.t.gn  mpeuancc  stjte 


z\jure  1  AD573  Functional  Block  D-agram 


1  ne  '-mperature  compensated  buried  /encr  reference  provides 
'he  primary  volrage  reterence  to  'he  DAC  .n<J  ensures  excellent 
taoihtv  with  "M»ih  ime  and  temperature.  The  bipolar  olfset 
.np.it  -•  n?r"ls  a  switch  whivh  ul«-ws  ihc  positive  bip0(jr  ,>tfSC( 

.  irrent  eta».t.v  equal  to  the  vaiue  .  I  'he  MSB  icss  [.SB  to  be 
.nicw'cd  m:  »  he  .umming  -  node  *c  :hc  .  >mparator  ro  olfset 
’he  D.V.  -utput  Thus  the  nominal  ■)  to  -  MY  unipolar  mput 
'  mge  becomes  i  A  :»j  *-  5  V  range  Hie  k  1  i  ’hsn  him  input 
•  >i  .t  -r  ,  frimmej  o  'hat  with  i  toil  -*.aie  nput  ognal.  .m 
nput  ^  .rrcr.t  will  ^e  generated  whi*.h  cxjvtlv  mai-hes  the  DAC 
.* put  .on  til  nils  >n 

UNIPOLAR  CONNECTION 

i  he  \ l)*"*  v  *  am  s  ill  ’he  i-uve  .ompouem^  required  «o 
perVrm  a -■>mt\c:e  V  0  .< -ncer  i>*n  I  hus.lormanv  ippiwanons. 
ul  'hat  .  riLvC  ar\  s  connection  »t  the  po-ver  oippucs  -  >V 
md  -V  *o  1  the  injiog  .nput  md  the  convert  pulse. 

I [.  we-.rr  here  ire  "rnc  features  md  -peual  connections  which 
h‘*uld  c  .  -r,  .idered  !"r  achieving  optimum  performance  l  he 
t.jnctnnai  -m-ui  s  hown  m  Figure  2 


The  standard  unipolar  0  to  10V  range  is  obtained  by  shorting 
the  bipolar  olfset  control  pin  .pin  16 1  to  digital  common 
pm  17). 

i$a 


MM 

Figure  2.  A 05 73  Pm  Connections 

Full  Scale  Calibration 

The  *kil  thin  film  mput  resistor  is  laser  trimmed  to  produce  a 
current  which  matches  the  full  scale  current  of  the  internal 
DAC-plus  about  0  3%-when  an  analog  input  voltage  of  9.990 
volts  10  volts  -  ILSB)  is  applied  at  the  input.  The  input  resis'or 
is  tnmmed  in  this  way  so  that  if  a  fine  trimming  potentiometer 
is  inserted  in  series  with  the  input  signal,  the  input  current  at 
the  full  scale  input  voitage  can  be  tnmmed  dowo  to  match  the 
DAC  full  scale  current  as  precisely  as  desired.  However,  for 
many  applications  the  nominal  9  99  volt  full  scale  can  be  achieved 
to  sufficient  accuracy  by  simply  inserting  a  150  resistor  in  senes 
with  the  analog  input  to  pm  14  Typical  full  scale  calibration 
error  will  then  be  within  -  2LSB  or  -0.2%.  If  more  precise 
calibration  is  desired,  a  500  trimmer  should  be  used  instead. 

Set  the  analog  input  at  9  990  volts,  and  set  the  trimmer  so  that 
»he  output  code  is  mst  at  ’.he  transition  between  11111111  10 
md  1 1 1 1 1 1 1 1  11.  Each  LbB  will  then  have  a  weight  of  9  ~66mV. 
II  a  nominal  full  scale  of  10.24  volts  is  desired  which  makes  the 
LhB  have  a  weight  of  exactly  10.00mV\  j  1000  resistor  and  a 
1001 1  trimmer  or  a  2000  trimmer  with  good  resolution,  should 
be  used.  Of  course,  larger  full  scale  ranges  can  be  arranged  by 
using  a  larger  input  resistor,  but  linearity  and  full  scale  temperature 
coefficient  may  be  compromised  it  the  external  resistor  becomes 
a  sizeable  percentage  of  5kil.  Figure  3  illustrates  the  connections 
required  for  full  scale  calibration. 


Figure  J  3taniijrd  A05/3  Conn,.\  fons 


Untpoiar  Offset  Calibration 

AinvC  the  Unipoiar  Olfset  is  less  than  •_  ll.SB  tor  hi  versions  of 
1‘ie  A I  4 .  most  applications  w  ill  not  require  trimming.  Figure 
l  illustrates  two  tr.mming  mcthtnls  which  can  be  used  it  greater 
iivurjiv  is  necessary 


VOL  I  ’ 0-50  ANALOG-  TO  DIGITAL  CONVERTERS 


hD573  a/D  Converter  cata  ,-jheet  (continued) 

Applying  the  AD 573 


Figure  4a  shows  how  the  convener  zero  may  be  offset  by  up  10 
±  3  bits  to  correct  the  device  initial  offset  and  or  input  signal 
offsets.  As  shown,  the  circuit  gives  approximately  symmetrical 
adjustment  m  unipolar  mode. 


* ,5V  ' ,5V  h  bp  «ro  of*srr 

mro  o«srr  *dj 
-.3  iit  range 

Figure  4a.  Figure  4b. 

Figure  5  shows  the  nominal  transfer  curve  near  zero  for  an 
AD573  in  unipolar  mode.  The  code  transitions  are  at  the  edges 
of  the  nominal  bit  weights.  In  some  applications  it  will  be  preferable 
to  offset  the  code  transitions  so  that  they  fall  between  the  nominal 
bit  weights,  as  shown  in  the  offset  characteristics. 

ouTKjy  |  r-“ 


ov  »-v  JO.. 

INRUT  VOtTAGf 


nominal  Characteristics 

RE  *  E  ARE  D  TO  ANALOG  COMMON 


Ov  iOmv 

■NRUT  VOITACF 

O'* If  »  ChARaCTIRISTiCSNiTh 
111.  >N  SI  "Its  WITH  ANALOG  COMMON 

Figure  5  AD573  Transfer  Curve  -  Unipolar  Operation 
Approximate  Bit  Weights  Shown  for  illustration.  Nominal 
Bit  Weights  9  766mVf 

Fhr.  ollsc:  can  casil\  be  accomplished  as  shown  in  Figure  4b 
At  balance  alter  a  conversion  approximate!)  2mA  flows  into 
the  Analog  ( .ommon  terminal  A  2  ~n  resistor  in  sene'  with 
hr  terminal  will  resuM  in  approximate!*.  the  UesirrJ  .  bit 
"IN-.-t  .  ;  the  transfer  „haracicr;stics  The  nominal  2mA  Analog 
*  »mm  «:.  l.u  Trent  is  no:  cio-tK  mn'.nincJ  in  manufacture  It 
hie:.  dLLun.v  is  required,  a  5!  1  potentiometer  conntvied  as  a 
rheostat  u;,  be  used  a*  Hi  Additional  negative  olfsei  ranee 
rruv  rx  obtaincJ  bv  using  larger  value'  <>;  Hi.  Ol  course,  il  the 
Arc  transition  pom'  is  changed,  the  full  scale  transition  pour 
'•Mil  dis..  m>*»i  Thus,  it  an  oitset  «t  .  LSB  is  introduced.  tul! 
■vaie  trimming  dcs.ribed  on  the  previous  page  should  be 
4' 'tie  with  an  analog  input  ol  V  9*5  volts 

N'^ri  During  a  u>n  version  transient  currents  from  the  Analog 
'•‘>mnv>n  terminal  will  disturb  the  offset  vnltagi  (^apaemve 
divojpiing  should  ni*.  be  uscu  around  the  oil  sit  network.  These 
'fdnsieius  w  ul  settle  appropriated  during  a  conversion  Capacitive 


decoupling  will  “pump  up"  and  fail  to  settle  resulting  in  conversion 
errors.  Power  supply  decoupling,  which  returns  to  analog  signal 
common,  should  go  to  the  signal  input  side  of  the  resistive 
offset  network. 

BIPOLAR  CONNECTION 

To  obtain  the  bipolar  —  5V  to  **-5V  range  with  an  offset  binary 
output  code,  the  bipolar  offset  control  pm  is  left  open. 

A  -  5.000  volt  signal  will  give  a  10-bit  code  of  00000000  00;  an 
input  of  0.000  volts  results  m  an  output  code  of  10000000  00 
and  4 .99  volts  at  the  input  yields  the  1 1 11 1 1 1 1  11  code.  The 
nominal  transfer  curve  is  shown  m  Figure  6. 


INRUT  VOLTAGE  -  mV 


Figure  6.  AD573  Transfer  Curve  -  Bipolar  Operation 

Note  that  in  the  bipolar  mode,  the  code  transitions  are  offset 
ViLSB  such  that  an  input  voltage  of  0  volts  z  5m V  yields  the 
code  representing  zero  (10000000  00').  Each  output  code  is  then 
centered  on  its  nominal  input  voltage. 

Full  Scale  Calibration 

Fuil  Scale  Calibration  is  accomplished  m  the  same  manner  as  in 
Unipolar  operation  except  the  full  scale  input  voltage  is  -4.98* 
volts 

Negative  FuU  Scale  Calibration 

The  circuit  in  Figure  4a  can  also  be  used  in  Bipolar  operation  to 
offset  the  input  voltage  *  nominally  -  5V-  which  results  in  the 
00000000  00  code  R2  should  be  omitted  to  obtain  a  svmmetncai 
range  * 

The  bipolar  oft  set  control  input  is  not  directly  TTL  compatible 
but  a  TTL  interface  for  logic  control  can  be  constricted  as 
shown  m  Figure  7. 


Ifcv 


Figure  7  Biooia'  Offset  Controlled  bv  Log  i  Cate 
Cate  Output  -  ?  Unipolar  0  -  10V  Input  Range 
Gate  Output  -  0  Bipolar  :  5V  Input  Ranor 

SAMPLE-HOLD  AMPLIFIER  CONNECTION  TO  THE 

AD573 

Manv  situations  in  high-speed  acquisition  svstems  or  digitizing 
rapidiv  changing  signals  require  a  sampie-hold  amplifier  <SHA 
in  ironi  o{  the  A-D  converter  The  SHA  can  acquire  and  hold  a 
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AD573  A/D  Converter  Data  Sheet  (continued) 


ugna i  faster  than  rhe  convener  can  perform  ,i  cunvcnion.  A 
■>HA  can  also  be  uwl  to  accurately  define  the  exact  point  in 
:ime  at  which  the  signal  is  sampled.  For  the  AD573,  a  SHA  can 
also  serve  is  a  high  input  impedance  bulfer. 

Figure  8  shows  the  AD573  connected  to  the  AD582  monolithic 
SHA  for  high  speed  signal  acquisition.  In  this  configuration,  the 
AD5S2  will  acquire  a  iO  volt  signal  in  less  than  lOua  with  a 
droop  rate  less  than  lOO^A’  ms. 


com 


Figure  8.  Sample-Hold  Interface  to  the  ADS 73 

DR  goes  high  alter  the  conversion  is  initiated  to  indicate  that 
reset  of  the  SAR  is  complete.  In  Figure  8  it  :s  also  used  to  put 
the  AD582  into  the  hold  mode  while  the  AD573  begins  its 
conversion  cvcle.  The  AD582  settles  to  final  value  well  in  advance 
of  the  first  vomparacor  decision  inside  fhe  KDS7S). 

DR  goes  low  when  the  conversion  is  complete  pUang  the  AD582 
back  in  the  sample  mode.  Configured  as  shown  in  Figure  8,  the 
next  conversion  can  be  initiated  after  a  10ns  delay  to  allow  for 
signal  acquisition  bv  the  AD582. 

Observe  carefuiiv  the  ground,  supply,  and  bypass  capacitor 
connections  between  the  two  devices.  This  will  minimize  ground 
noise  and  interference  during  the  conversion  cycle. 

GROUNDING  CONSIDERATIONS 

The  AD573  provides  separate  Anaiog  and  Digital  Common 
connections.  The  >.irv.uit  will  operate  properly  with  is  much  as 
-  20dm  V  of  common  mode  voltage  between  the  two  commons. 
This  permits  more  flexible  control  of  system  common  bussing 
and  digital  and  analog  returns. 

In  normal  operation,  the  Analog  Common  terminal  mav  generate 
transient  currents  of  up  to  2mA  during  a  conversion.  In  addition 
a  static  current  of  ibout  2mA  will  flow  into  Analog  Common  m 
the  unipolar  mode  after  a  conversion  is  complete.  The  Analog 
Common  current  will  be  modulated  bv  ’he  variations  in  input 
signal. 

The  absolute  maximum  voltage  rating  between  the  wo  commons 
is  £  1  volt.  It  is  recommended  that  a  parallel  pair  of  ^ack-'o-back 
protection  diodes  he  connected  between  -he  commons  if  'hev 
ire  'iot  connected  locally. 

CONTROL  AND  TIMING  OF  THE  AD573 

The  operation  of  the  AD 57 3  is  controlled  bv  three  inputs:  CON- 
VERT.  HBE  and  LBE. 

Starting  a  Conversion 

The  conversion  v.\cle  is  initiated  bv  a  positive  going  CONVERT 


pulse  at  least  300ns  wide.  The  rising  edge  of  rhis  pulse  resets 
the  internal  logic,  cicars  the  result  of  the  previous  conversion, 
and  sets  DR  high.  The  tolling  edge  of  CONVERT  begins  the 
conversion  cycle.  When  conversion  is  completed  DR  returns 
low.  During  the  conversion  cvcle,  HBE  and  LBE  should  be 
held  high.  If  HBE  or  LBE  goes  low  during  a  conversion,  the 
data  output  buffers  will  be  enabled  and  intermediate  conversion 
results  will  be  present  on  the  data  output  pins.  This  may  cause 
bus  conflicts  if  other  devices  in  a  system  arc  trying  to  use  the 
bus. 


Figure  9.  Convert  Timing 

Reading  the  Data 

The  three-state  data  output  buffers  are  enabled  by  HBE  and 
LBE.  Access  time  of  these  buffers  is  typically  150ns  1 250 
maximum).  The  Data  outputs  remain  valid  until  50ns  after  the 
enable  signal  returns  high,  and  are  completely  into  the  high-im- 
pcdance  state  100ns  later. 


Figure  10.  Read  Timing 


TIMING  SPECIFICATIONS  (All  grades,  TA  =  Tw  -  T^j 


Parameter 

Symbol 

Min 

Typ 

Mm 

Units 

CONVERT  Pulse  Width 

Vs 

500 

_ 

. 

ns 

DR  Delay  from  CONVERT 

*  DSC 

- 

1 

1.5 

Conversion  Time 

V 

10 

:o 

30 

liS 

Data  Access  Time 

Data  Valid  after  HBE  LBE 

•DO 

0 

150 

:?o 

ns 

High 

•HD 

50 

- 

- 

ns 

Output  Float  Delay 

f  ML 

- 

100 

:oo 

ns 

MICROPROCESSOR  INTERFACE  CONSIDERATIONS  - 
GENERAL 

When  an  inalog-fo-digital  converter  i;ke  the  AD573  .s  interfaced 
to  a  microprocessor,  several  details  of  the  •.menace  must  be 
considered.  First,  a  signal  to  start  the  convener  must  be  generated; 
then  an  appropriate  delay  penod  must  be  allowed  to  pass  before 
valid  conversion  data  may  be  read.  In  most  applications,  -he 
AD573  can  interface  to  a  microprocessor  system  with  iit’Je  or  no 
external  logic. 

The  most  popular  control  signal  configuration  consists  of  decoding 
•  he  iddress  assigned  to  the  AD5'3.  rhen  ganng  his  .gnal  with 
the  system's  'X'R  signal  to  generate  :hc  CoN\  i.RT  puj.e.  and 
gating  tt  ’virh  RD  fo  enable  :he  output  buffers.  The  u%e  . >i  a 
memory  address  and  memorv  X'R  and  RD  ognais  denotes 
‘mcrr.orv -mapped”  l  O  interfacing,  while  'he  use  >t  a  -.eparate 
I  O  iddress  spice  denotes  "  solated  I  O”  merfaung  In  S-hit 
bus  systems .  rhe  10-Nt  \D57?  will  occupv  »*vn  i*H.at:ons  when 
•fata  is  'o  he  read,  mererore.  :wo  •.i-.uailv  ,ocutive  addresses 
must  ^e  decoded.  One  ot  'he  addresses  ^an  aiso  he  used  as 
rhe  address  whiwh  produces  the  CONVERT  signal  dunr.g  X'R 
■  ‘perjtions. 

F-gure  11  .hows  a  aer.erali/cd  diagram  ot  he  .ontml  ;  >r 
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AD573  A/E>  Converter  Data  sheet  (continued) 


an  AD573  interlaced  to  an  fc-bit  data  bus.  where  two  addresses 
ADC.  A  DDK  and  ADC  ADDR  -  1  have  beer,  decoded.  ADC 
ADDR  starts  the  converter  when  written  to  the  actual  data 
being  written  to  the  convener  docs  not  matter  and  contains  the 
high  byte  data  during  read  operations  ADC  ADDR-*-  1  pcrlorms 
no  function  during  write  operations,  but  contains  the  Jow  byte 
data  during  read  operations 


.  .  J  AOOfl  I 

\  BUS  OtCOWNG 


DECODING  j 

LOC,c  j>-j— j 
55c  ados  ♦ '  1 


Figure  11.  General  AD573  Interface  to  8-Bit 
Microprocessor 

In  svstems  where  this  read-write  interlace  is  used,  at  least  30 
microseconds  the  maximum  conversion  time  must  be  allowed 
to  pass  between  starting  a  conversion  and  reading  the  results. 
This  delay  or  “timeout"  penod  can  be  implemented  in  a  short 
software  routine  such  as  a  countdown  loop,  enough  dummy 
instructions  to  consume  30  microseconds,  or  enough  actual 
useful  instructions  to  consume  the  required  time  In  tightlv-umed 
systems,  the  DR  line  may  be  read  through  an  external  three-state 
buffer  to  determine  precisely  when  a  conversion  is  complete. 
Higher-speed  svstems  may  choose  to  use  DR  to  signal  an  interrupt 
to  the  processor  at  the  end  of  a  conversion. 

ADC  AOOA 

ADC  ADO*  ADC  ADO*  ♦  I 

•OO...S - :  1  / - !  <  / — i  «  / — 


Figure  V.  Typical  ADS 73  Interface  Timing  Diagram 

CONVERT  Pulse  Generation 

The  AD57?  ic  tested  with  a  CONVERT  pulse  width  of  500ns 
and  will  tvpicafh  operate  with  a  pulse  as  short  as  300ns.  However, 
some  microprocessors  produce  active  W’k  pulses  which  are 
shorter  than  this  Either  of  *  he  circuits  shown  in  Figure  13  can 
be  used  to  generate  an  adequate  CONVERT  pulse  for  the  AD573. 


Interfacing  to  the  AD573 

In  both  circuits,  the  short  low-going  WR  pulse  sets  the  CONVERT 
line  high  through  a  flip-flop  The  rising  edge  of  DK  which 
signifies  that  the  internal  logic  has  been  reset  resets  the  flip-flop 
and  brings  CONVERT  low ,  which  starts  the  conversion 
Note  that  lust  is  slightly  longer  when  the  result  ot  the  previous 
conversion  contains  a  logic  J  on  the  LSB  This  means  that  the 
actual  CONVERT  pulse  generated  bv  the  circuits  in  Figure  13 
will  vary-  slightly  m  w-idth, 


, - 1  D  Q  | - — jCONVCBT 


Figure  13a.  Using  74LS00  Figure  13b  Using  1  2  74LS74 

Output  Data  Format 

The  AD573  output  data  is  presented  in  a  ieft-iustified  format. 
The  8  MSBs  (DB9-DB2,  pins  10  through  3,  are  enabled  by 
HBE  .pin  20:  and  the  2  LSBs  DB1,  DBO  -  pins  2  and  1 1  are 
enabled  by  LBE  i.pin  19 1.  This  allows  simple  interface  to  S-bn 
svsrem  buses  by  overlapping  the  2  MSBs  and  the  2  LSBs.  The 
organization  of  the  data  is  shown  in  Figure  14. 

When  the  least  significant  bits  are  read  LBE  brought  low  u.  the 
six  remaining  bits  of  the  byte  wiil  contain  meaningless  data 
These  unwanted  bits  can  be  masked  by  logically  ANDing  the 
byte  with  1 1000000  ^C0  hex),  which  forces  the  6  lower  bus  to 
logic  0  while  preserving  the  two  most  significant  bus  of  the 
byte. 

Note  that  u  is  not  possible  to  reconfigure  the  AD5“?  for  right 
justified  data. 


HBE  DB9  DB8  DB7  DB6  DB5  OB4  DB3  DB2 


LBE  DB1  DBO  X  X  X  X  X  j  X 

Figure  14  AD573  Output  Data  Format 

In  systems  where  all  10  bus  are  desired  at  the  same  time.  HBE 
and  LBE  may  be  tied  together.  This  is  usefu,  in  interfacing  to 
16-bu  bus  svstems.  The  resulting  10-bu  word  can  then  be  placcu 
at  the  high  end  of  the  16-bu  bus  tor  left  lustification  or  a-  the 
low  end  for  right  lustification . 

It  r  also  possible  to  use  the  AD573  itt  a  “stand-alone  m.'Uc 
where  the  output  data  butlers  are  automations  enabled  a'  the 
end  ol  a  convcmoi  ..vcit.  In  this  mode.  the  DK  output  is  uirec 
to  the  HBE  and  LBE  inputs  The  outputs  in  us  arc  lorvcJ  into 
the  high-impedance  state  during  the  conversion  period,  and 
valid  data  txrcomes  available  approximately  50Jns  after  the  DR 
signal  goes  low  at  the  end  of  the  conversion  The  <Hjon>  dvias 
allow  ,  propagation  of  the  least  significant  bn  through  the  internal 
logic 

This  mode  is  particularly  useful  for  bench-testing  of  the  AD5~3. 
and  in  applications  where  dedicated  l  O  ports  of  peripheral 
interface  adapter  chips  are  available 
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figure  15.  AD573m  Stand-Alone  '  Mode 
>  Outout  Data  Valid  500ns  After  DR  Goes  Low) 

Apple  II  .Microcomputer  Interface 

The  AD5"?  van  provide  a  flexible,  low-u>st  analog  interlace  tor 
'he  popular  Apple  II  microcomputer.. The  Apple  II.  based  on  a 
IMH^  micro  processor.  meets  all  riming  requirements  tor 
the  AD573  Onlv  a  tew  TTL  gates  are  required  to  decode  the 
v.gnals  available  on  the  Apple  IPs  peripheral  connector.  The 
recommended  connections  are  shown  in  Figure  16. 


F-jjure  1 6 .  A0573 Interface  loAoole  U 


Jcjjv  between  starting  jnd  reading  the  ..inverter.  This  «.jii  be 
easuv  implemented  bv  calling  the  AppicA  WAIT  subroutine 
which  resides  at  location  SFCA#>  alter  loading  the  accumulator 
with  a  number  greater  than  or  equal  ro  two. 

8085-Series  Microprocessor  Interface 

The  AD573  can  also  be  used  with  8U85-senes  microprocessors. 
These  processors  use  separate  control  signals  tor  RD  and  WR, 
as  opposed  to  the  single  RW  control  signal  used  in  the  6800  65<)0 
series  processors. 

There  are  two  constraints  related  to  operation  of  the  AD5"3 
with  8085-senes  processors.  The  first  problem  is  the  width  of 
the  CONVERT  pulse.  The  circuit  shown  in  Figure  17  essentially 
the  same  as  that  shown  ;n  Figure  13'  will  produce  a  wide  enough 
CONVERT  pulse  when  the  8085  is  running  at  5MHz.  For  8085 
svstems  running  at  dower  clock  rates  ■  3.MHz\  the  tlip-rtop-based 
circuit  can  be  eliminated  since  the  WR  pulse  will  be  approximately 
500ns  wide. 

The  other  consideration  is  the  access  time  of  the  AD573A  three- 
state  output  data  buffers,  which  is  250ns  maximum.  It  mav  be 
necessary  to  insert  wait  states  durng  RD  operations  from  the 
AD573.  This  will  not  be  a  problem  in  systems  using  memories 
with  comparable  access  times,  since  wait  states  w.'il  have  already 
been  provided  m  the  basic  system  design. 


Figure  17  AC573-8085A  interface  Connections 


The  following  assembly-language  subroutine  can  be  used  ro 
control  an  AD573  residing  at  memory  locations  5000m  and  500 1 h 
The  10  bits  of  data  arc  returned  lett- justified  in  the  DE  register 
pair 


The  BASIC  routine  listed  here  will  operate  the  AD573  circuit 
•»hown  m  Figure  16.  The  conversion  is  starred  by  POKEing  to 
*he  location  which  contains  'he  AD573.  The  relatively  slow 
execution  speed  ot  BASIC  eliminates  the  need  for  a  delav  routine 
Detween  starting  and  reading  the  converter.  This  routine  issumes 
that  the  ADS' 3  is  connected  tor  a  t  5  voit  input  unge  Variable 
I  represents  the  integer  -alue  from  <J  ro  1023  read  from  ihe 
AD573.  Variable  V  represent';  'he  actual  value  of  'he  .nput 
ngnal  in  voits  . 

!fJ0  PRINT  'WHICH  SLOT  IS  IHE  A  D  IN  '  INPL  I  s 
MO  V  -  -02*0  *  16*S 
120  POKE  A .0 

150  L  -  PEEK  A  H  -  PEEK  A  -  l 
140  I  4-H,  -  IN  r  I  64 
I'll  V  -  f  1024  .MO-S 

lv)  PRIN  r  THE  INPUT  SIGNAL  IS  ‘.V.  Vnl.  TS  ‘ 


ADC.  LX  I  H.  3000  ,  LOAD  HL  WITH  AD575  ADDRESS 
MOV  M.  A  ,  START  CONVERSION 
MV  I  3.06  ,  LOAD  DELAY  PERIOD 

LOOP  DCR  3  .DELAY  LOOP 

JNZ  LOOP  . 

MOV  \.M  .  READ  I  t  »V  BYTE 

AM  CO  .MA.sK  LOWER  BITS 

MOV  E.  A  All  ’RE  (I.  LAN  LOW  BYTE  IN  E 

I  NR  !.  1.0  \[>  HUdl  BYTE  ADDRESS 

mov  o. m  move; hich byte.  n>n 

r  i  r  i  x  i  r 


It  is  also  jxissible  io  write  a  taster  executing  assemble  language 
routine  fo  control  »hc  AD573  such  j  routine  -vill  require  a 
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□  ANALOG  High  Speed 

DEVICES  Implanted  FET-Input  Op  Amp 

I  AD544 


FEATURES 

Low  Bias  Currant:  25pA  max.  warmed-up 

Low  Offset  Voltage:  SOOpV  max 

Low  Offset  Voltage  Drift:  5pV/°C  max 

Low  Input  Voltage  Noise:  2 pV  p-p 

Low  Quiescent  Current:  2.5mA  max 

High  Slew  Rate:  13V/ps 

Fast  Settling  to  £0.01%:  3ps 

Low  Total  Harmonic  Distortion:  0.0015%  at  1kHz 


AD 5 44  FUNCTIONAL  BLOCK  DIAGRAM 


TAD 


PRODUCT  DESCRIPTION 

The  AD544  is  a  high  speed  monolithic  FET-inpur  operational 
amplifier  fabricated  with  the  most  advanced  bipolar.  JFET  and 
laser  trimming  technologies.  The  AD544  offers  bias  currents 
significantly  lower  than  currently  available  monolithic  FET- 
input  devices;  25pA  max.  warmed-up  for  the  AD544K  and  L. 
50pA  max  for  the  AD544J  In  addition,  the  offset  voltage  is 
laser  r rimmed  to  less  than  0.5m  V  on  the  AD544L  and  J.OmV 
on  the  AD544K  utilizing  Analog's  lascr-wafer-trimming  ( LWT ) 
process.  When  combined  with  the  AD544  s  low  offset  voltage 
drift  (SjiVrc  max  for  "L”,  HtyiV^C  max  for  “K").  these 
fcarures  offer  the  user  1C  performance  truly  superior  to  exist¬ 
ing  FET-input  op  amps— and  at  low.  monolithic  pricing. 

The  key  technology  required  for  monolithic  J  FET-input  op 
amps  is  the  ion-implanted  JFET.  lon*jmpJantarion  (as  opposed 
to  diffusion)  permits  the  fabrication  of  precision,  matched 
JF  ET’s  on  a  monolithic  bipolar  chip.  Analog  Devices  optimizes 
the  process  to  produce  bias  currents  lower  than  other  popular 
FLT-input  op  amps  and  specifies  each  device  for  the  maximum 
value  at  either  input  in  the  fully  warmed-up  condition.  Addi¬ 
tional  benefits  of  this  optimization  include  low  voltage  noise 
'  p-p.  0  1  —  10M/J.  and  low  quiescent  current 
The  AD544  is  recommended  for  any  operational  amplifier 
application  requiring  excellent  ac  and  dc  performance  at  low 
cost  The  2MHz  bandwidth  and  low  offset  of  the  AD544  make 
i’  an  excellent  choice  as  an  output  amplifier  for  current  out¬ 
put  D/A  Converters  such  as  the  AD754I.  12-Bit  CMOS  DAC 
High  common  mode  rejection  i80dB,  min  on  the  "K" 
and  L  versions)  and  open-loop  gain  ensures  better  than 
^  2-bit  linearity  in  high  impedance  buffer  applications. 

The  AD 5 44  is  available  m  four  versions  the  “J”.  ‘K’'  and 
..ar,C  sPCCIf*cd  over  the  0  to  ♦70‘C  temperature  range  and 
e  S  over  the -55  C  to  *  125°C  operating  temperarurc 
range.  All  devices  are  packaged  in  the  hermeticallv-sealed, 
TO-99  metal  can. 


PRODUCT  HIGHLIGHTS 

1.  Improved  bipolar  and  JFET  processing  on  the  AD544 
results  in  the  lowest  bias  current  available  m  a  high  speed 
monolithic  FET  op  amp. 

2.  Analog  Devices,  unlike  some  manufacturers,  specifics  each 
device  for  the  maximum  bias  current  at  either  input  in  the 
warmed-up  condition,  thus  assuring  the  user  that  the 
AD544  wi//  meet  its  published  specifications  in  actual  use 

3.  Laser-wafer-tnmmmc  reduces  offset  voltage  to  as  low  as 
0.5mV  max  ( AD544L),  thus  eliminating  the  need  for  ex¬ 
ternal  nulling  in  many  situations 

4.  If  offset  nulling  is  required,  the  additional  offset  voltage 
drift  induced  will  be  minimal.  (In  some  devices,  offset 
voltage  drift  can  increase  an  additional  3pV/  C  per  mV 
of  offset  nulled.) 

5  Low  voltage  noise  (2yV.  p-p  > .  and  low  offset  voltage  drift 
(5/iV'  C)  enhance  the  AD544's  performance  as  a  precision 
op  amp. 

6.  The  high  slew  rate  (13.0V/^s)  and  fast  settling  time  to 
0.01%  <  3.0ys)  make  the  AD 544  ideal  for  D/ A.  A/D,  sample- 
hold  circuits  and  high  speed  integrators. 

7.  Low  harmonic  distortion  (0.0015%)  makes  the  AD544  an 
ideal  choice  for  audio  applications. 
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AD544  Operational  Amplifier  Data  Sheet  (continued) 
SPECIFICATIONS  ((a  +25°C  and  Vs=  ±15V  dc) 


OUTFIT  CHARACTERISTICS 
Voltage (it  ft i  *  2UJ.T.*  it.  T. 

Votive  mi  Rt  *  lOLUT^tuT 
Shon  Circuit  Current 


FREQUENCY  RESPONSE 
I'miv  Gun  Small  Signal 
Full-Power  Response 
Slr»  Rate.  Unity  Gain 
Settling  Tunc  toO.OIS 
T  (XU  Harmonic  Distortion 


III 

r  12 

*  12 

2  11 

25 

xlf 

r  12 

til 

r  11 

25 

Mm 

AD544L 

Trp  Maa 

tt.ogG 

ao.ooc 

ill 

r  12 

x  12 

r  13 

25 

200 

10 

a  o 

i  0 

0  0 025 

2-0 

200 

so 

130 

1  0 

0  0025 

200 

SO 

13  0 

3.0 

0.0025 

2  20 

til 

74 

*12 

INPUT  BIAS  CURRENT 
Either  Input 
Off»ci  Current 


IN  PIT  IMPEDANCE 
Difrerenual4 
Common  Mode 


INPUT  VOLTAGE  RANGE 
Differential 
Common  Mode 
Common  Mode  Reaction 


INPUT  NOISE 
Voltage 0  lHx  to  IQHi 
f  •  lOHr 
f*  lOOHi 
f- I kHz 
/-  IWtH/ 


POWER  SUPPLY 
Rated  Pert  ormaact 
Operating 
Quieacem  Currant 


TEMPERATURE  RANGE 
Operating,  Rated  Performance 


PACKAGE 
TO-90  Style  rNMB 


NOTES 

‘Open  Loop  Gam  a  pmfad  atth  Vw  both  nuilsd  and  uaauikd 
;iaput  Off  ter  Voltage  tpcnimooM  an  guaraataod  after  5  ounum 
ol  operation  nT,  ■  -  2?*C 

'B*»  Current  macificBMoa*  we  guaranteed  at  tnaauman  at  other 
input  after  5  minutes  of  operation  itT.  •  ♦  2!*C  For 
togAcr  ccmperwum.  the  current  doubles  every  ICC 
‘Defined  at  voltage  bewwt  utputi.  n*cb  that  — that  enceada  -  l(T 
tram  ground 
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25 
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23 

r  tl 

l  • 

2.5 
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-  70 

-65 

♦  150 
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-70 

-65 

*  150 

2  IS 

=  5 

r  IS 

l.s 

2.5 

0 

-  70 

-65 

♦  150 

’See  Section  1*  to»  package  outline  «fa» 


SpeoficauoBi  mown  in  bold  fare  are  tetrad  on  all  production  uMta  at  ftnaJ 
ciecmcaJ  test  Result*  tram  those  testa  m  ussd  to  calcuiste  outgoing  qualirv 
level*  Ail  min  and  mai  apca/icatMOa  are  fuaranrned  Wrhougtt  oatr  rhosr 
Ml  m  bold! see  are  tested  on  all  production  unit* 
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APPENDIX  B 


Digital  Interface  Schematic  Diagrams  . 

Circuit  Card  I:  Digital  Interface  Parts  List 
Digital  Interface  Device  Layout  . 


DIGITAL  INTERFACE  SCHEMATIC  DIAGRAMS 


DIGITAL  INTERFACE  SCHEMATIC  DIAGRAMS  (continued) 


DIGITAL  INTERFACE  SCHEMATIC  DIAGRAMS  (continued) 


<*v . 


DIGITAL  INTERFACE  SCHEMATIC  DIAGRAMS  (continued) 


DIGITAL  INTERFACE  SCHEMATIC  DIAGRAMS  (continued) 


Circuit  Card  I:  Digital  Interface 
Parts  List 


Part  Number 


Type 


Schematic  Reference  # 


7440 

Dual  4-Input  Positive 
NAND  Buffers 

7404 

Hex  Inverters 

7432 

Quadruple  2-Input 
Positve-OR  Gates 

74173 

4-Bit  D-Type  Register 
With  3-State  Outputs 

7428 

Quadruple  2-Input 
Positive-NOR  Gates 

AD  573 

10-Bit  Analog  to 
Digital  Converter 

7421 

Dual  4-Input  Positive 
AND  Gates 

AD  544 

Precision  Operational 
Amplifier 

LM  747 

Dual  Operational 
Amplifiers 

CD  4066 

Quad  Bilateral  Switch 

1445 

Dual  Monostable 
Multivibrator 

Circuit  Card  I:  Digital  Interface 
Parts  List  (Continued) 


Part  Number 


Type 


Schematic  Reference  # 


5082/7340 

Single  Digit  HEX  LED 
Display  with  Latches 
and  Driver 

100 

Variable  Resistor 
(Ohms ) 

20 

Resistor  (Ohms) 

360 

Resistor  (Ohms) 

1 0K 

Variable  Resistor 
(Ohms) 

50K 

Resistor  (Ohms) 

1 0K 

Resistor  (Ohms) 

20K 

Variable  Resistor 
(Ohms ) 

27K 

Resistor  (Ohms) 

1 30K 

Resistor  (Ohms) 

1 . 5K 

Resistor  (Ohms) 

Circuit  Card  I:  Digital  Interface 
Parts  List  (Continued) 


Part  Number  Type 


Schematic  Reference  # 


0.01  Micro  Capacitor  (Farads)  Cl 

C2 

C3 

C4 

C5 

C6 

C7 

C8 

C9 

CIO 

C11 

C12 

C13 

C16 

C17 

C18 


2220  Micro  Capacitor  (Farads)  C14 


1.0 


Capacitor  (Farads) 


DIGITAL  INTERFACE  DEVICE  LAYOUT 


APPENDIX  C 


Syncro  to  Digital  Schematic  Diagram  . 

Circuit  Card  G:  Syncro  to  Digital  Parts  List 
Syncro  to  Digital  Device  Layout  . 


C-1 


SYNCRO  TO  DIGITAL  SCHEMATIC  DIAGRAM 


Circuit  Card  G:  Syncro  to  Digital 
Parts  List 


Part  Number 


SDC  1700 


74173 


74121 


IK 


15  pico 


Type 


Schematic  Reference  tt 


Syncro  to  Digital  U1 

Converter 

4-3it  D-Type  Register  U2 

With  3-State  Outputs  U3 

U4 

U5 

Monostable  U6 

Multivibrator 

Resistor  (Ohms)  R1 

R2 

R3 

Capacitor  (Farads)  Cl 


APPENDIX  D 


GYRAC  Computer  Schematic  Diagrams  . 

Circuit  Card  C:  Computer  Controller  Parts  List 

GYRAC  Computer  Memory  Map  . 

GYRAC  Computer  Device  Layout  . 


GYRAC  COMPUTER  SCHEMATIC  DIAGRAMS 


GYRAC  COMPUTER  SCHEMATIC  DIAGRAMS 


Circuit  Card  C:  Computer  Controller 
Parts  List  (Continued) 


Part  Number 


Type 


Schematic  Reference  ft 


MC7912CT 

Negative  12  Volt 
Voltage  Regulator 

MB8416A 

CMOS  2048  x  8  Byte 
Static  RAM 

1N914 

Signal  Diode 

3579.545  KC 

Crystal  Oscillator 

3K 

Resistor  (Ohms) 

1 0K 

Resistor  (Ohms) 

IK 

Resistor  (Ohms) 

2.7K 

Resistor  (Ohms) 

22  Pico 

Capacitor  (Farads) 

0.01  Micro 

Capacitor  (Farads) 

100  Micro 

Capacitor  (Farads) 
50  WVDC 

s? 


GYRAC  COMPUTER  MEMORY  MAP 


ADDRESS 
0000  to 
6000  to 

8000 

8001 

8002 

8003 

AOOO 

A001 

C000 

C001 

C002 

COO  3 

C004 

C005 


(HEX)  DEVICE 


007F  0128  Bytes  of  on  Processor  Scratchpad  RAM 

67FF  2048  Bytes  of  RAM 

(Alternate  Addresses  7000-77FF) 

PIA  Data  Direction/Peripheral  Register  A 
(Alternate  Address  9000) 

PIA  Control  Register  A 
(Alternate  Address  9001) 

PIA  Data  Direction/Peripheral  Register  3 
(Alternate  Address  9002) 

PIA  Control  Register  B 
(Alternate  Address  9003) 

ACIA  Control/Status  Register 
(Alternate  Address  B000) 

ACIA  TX  Data/RX  Data  Register 
(Alternate  Address  3001) 

PTM  Write  Control  Register  -r3/^1 
(Alternate  Address  D000) 

PTM  Write  Control  "2/Status 
Registers 

(Alternate  Address  D001) 

PTM  MSB  Buffer  1  Register/Timer  "1 
Counter 

(Alternate  Address  D002) 

PTM  Timer  4?1  Latches/LSB  Buffer  *1 
Register 

(Alternate  Address  D003) 

PTM  MSB  Buffer  "2  Register/Timer  ^2 
Counter 

(Alternate  Address  D004) 

PTM  timer  ?2  Latches/LSB  Buffer  #2 
Register 

(Alternate  Address  D005) 


GYRAC  COMPUTER  MEMORY  MAP  (continued) 


ADDRESS 

C0060 

C007 

E000  to 

E3FE  to 
E3FC  to 

E3FA  to 


(HEX) 


DEVICE 


PTM  MSB  Buffer  #3  Register/Timer  #3 
Counter 

(Alternate  Address  D006) 

PTM  Timer  #3  Latches/LSB  Buffer  *3 
Register 

(Alternate  Address  D007) 

E3FF  1024  Bytes  of  GYRAC  Control  Program 

in  EPROM  (Alternate  Addresses 
F000-F3FF) 

E3FF  Address  of  Reset  Vector 

E3FD  Address  of  Non-maskable  Interrupt 

Vector 

E3FB  Address  of  Software  Interrupt 

Vector 


E3F8  to  E3F9 


Address  of  Interrupt  Vector 


GYRAC  COMPUTER  DEVICE  LAYOUT 


APPENDIX  E 


GYRAC  Power  Panel  . 

GON:  Syncro  to  Digital  Edge  Connector  .... 

C1P:  GYRAC  Computer  Sensor  Bus  Connector  . 

C1E:  GYRAC  Computer  Edge  Connector  . 

ION:  Digital  Interface  Edge  Connector  . . . . 

H89  to  GYRAC  RS-232  Cable  . 

H89  to  NAY  T  or  Drive  Computer  RS-232  Cable 

GYRAC  to  NAV  L  Computer  RS-232  Cable  . 

Drive  Computer  to  NAV  X  RS-232  Cable  . 

GYRAC  Wiring  Harness  . 


GYRAC  POWER  PANEL 


GON :  Syncro  to  Digital  Edge  Connector 


Pin  Number  Signal  Name  Description 


GON  1 

None 

GYRO  Base  Ground 

G0N2 

None 

GYRO  Base  28  Volts  400  Hertz 

G0N3 

None 

GYRO  Indicator  S2 

G0N4 

None 

GYRO  Indicator  SI 

GON  5 

None 

GYRO  Indicator  SO 

G0N6 

Unused 

G0N8 

G0S42 

Angular  Velocity  Analog  Signal 

GON  13 

G0S41 

S  to  D  Busy  Signal  (unused) 

GON  1 5 

Unused 

GON  16 

Unused 

GON  17 

Unused 

GON  18 

GOROO 

DO  Data  Bit 

GON  19 

G0R01 

D1  Data  Bit 

G0N20 

G0R02 

D2  Data  Bit 

G0N21 

G0R03 

D3  Data  Bit 

G0N22 

G0R04 

D4  Data  Bit 

GONA 

None 

Digital  Ground 

GONF 

None 

+15  Volts  DC 

GONH 

None 

+15  Volts  DC 

GONJ 

None 

-15  Volts  DC 

GONK 

None 

-75  Volts  DC 

GONL 

None 

Analog  Ground 

GONM 

None 

Analog  Ground 

GONN 

None 

+5  Volts  DC 

GONP 

None 

+5  Volts  DC 

GONT 

G0R05 

D5  Data  Bit 

GONU 

G0R06 

D6  Data  Bit 

GONV 

G0R07 

D7  Data  Bit 

GONW 

G0R08 

D8  Data  Bit 

GONX 

G0R09 

D9  Data  Bit 

GONY 

G0R10 

DIO  Data  Bit 

GONZ 

GOR 1  1 

Dll  Data  Bit 

C1P:  GYRAC  Computer  Sensor  Bus  Connector 


n  Number 

Signal  Name 

Description 

C1P1 

Unused 

C1P2 

Unused 

C1P3 

Unused 

C1P4 

Unused 

C1P5 

Unused 

C1P6 

Unused 

C1P7 

Unused 

C1P8 

Unused 

C1P9 

Unused 

C1P10 

Unused 

C1P1  1 

Unused 

C1P12 

Unused 

C1P13 

Unused 

C1P14 

Unused 

C1P15 

Unused 

C1P16 

C1B10 

Reserved  (unused) 

C1P17 

None 

+5  Volts  (thru  pullup 

resistor) 

C1P18 

C1B1 1 

Reserved  (unused) 

C1P19 

C1B30 

Interrupt  In  (unused) 

C1P20 

Unused 

C1P21 

C1B31 

Read/Write  Out 

C1P22 

None 

+5  Volts  (thru  pullup 

resistor) 

C1P23 

C1B03 

A3  Sensor  Address  Bit 

C1P24 

C1B01 

A1  Sensor  Address  Bit 

C1P25 

C1B25 

D5  Sensor  Data  Bus 

C1P26 

C1B23 

D3  Sensor  Data  Bus 

C1P27 

C1B21 

D1  Sensor  Data  Bus 

C1P28 

C1B27 

D7  Sensor  Data  Bus 

C1P29 

C1B26 

D6  Sensor  Data  Bus 

C1P30 

C1B20 

DO  Sensor  Data  Bus 

C1P31 

C1B22 

D2  Sensor  Data  Bus 

C1P32 

C1B24 

D4  Sensor  Data  Bus 

C1P33 

None 

+5  Volts  (thru  pullup 

resistor) 

C1P34 

C1B00 

AO  Sensor  Address  Bit 

C1P35 

C1B02 

A2  Sensor  Address  Bit 

C1P36 

None 

+5  Volts  (thru  pullup 

resistor) 

C1P37 

None 

Digital  Ground 

C1P38 

None 

Digital  Ground 

C1P39 

None 

Digital  Ground 

C1P40 

None 

Digital  Ground 

C IE:  GYRAC  Computer  Edge  Connector 


Pin  Number  Signal  Name 


Description 


C1E1 

None 

Digital  Ground 

C1E2 

C1G01- 

Tx  Data  Out  (active  low) 

C1E3 

None 

Rx  Data  In  (active  low) 

C1E4 

C1G00- 

Ready  to  Send 

C1E5 

None 

+5  Volts  DC  Out 

C1E6 

Unused 

C1E7 

Unused 

C1E8 

None 

+5  Volts  DC  Out 

C1E9 

Unused 

C1E10 

None 

Power  On  Reset  (active  low) 

C1E1 1 

Unused 

C1E12 

None 

+15  Volts  DC  In 

C1E13 

Unused 

C1E14 

None 

-12  Volts  DC  Out 

C1E15 

Unused 

C1E16 

None 

+12  Volts  DC  Out 

C1E17 

Unused 

C1E18 

None 

-5  Volts  DC  Out 

C1E19 

Unused 

C1E20 

Unused 

C1E21 

None 

-15  Volts  DC  In 

C1E22 

Unused 

C1EA 

None 

Digital  Ground 

C1EB 

Unused 

Cl  EC 

Unused 

C1ED 

Unused 

C1EE 

Unused 

C1EF 

Unused 

C1EH 

None 

Unused 

C1EJ 

Unused 

C1EK 

Unused 

Cl  EL 

Unused 

Cl  EM 

Unused 

C1EN 

Unused 

C1EP 

Unused 

C1ER 

Unused 

C1ES 

Unused 

C1ET 
C1EU 
C1EV 
C1EW 
Cl  EX 
C1EY 
C1EZ 


Unused 

Unused 

Unused 

Unused 

None  +5  Volts 

Unused 
+5  Volts 


(thru  pullup  resisto 
DC  In 


None 


ION:  Digital  Interface  Edge  Connector 


Pin  Number  Signal  Name  Description 


I  ONI 

Unused 

I0N2 

Unused 

I0N3 

Unused 

1 0N4 

Unused 

1 0N5 

Unused 

I0N6 

GOROO 

S/D  DO  Data  Bit 

1 0N7 

G0R01 

S/D  D1  Data  Bit 

1 0N8 

G0R02 

S/D  D2  Data  Bit 

1 0N9 

G0R03 

S/D  D3  Data  Bit 

I0N10 

G0R04 

S/D  D4  Data  Bit 

I  ON  1 1 

G0R05 

S/D  D5  Data  Bit 

I  ON  12 

G0R06 

S/D  D6  Data  Bit 

I0N13 

G0R07 

S/D  D7  Data  Bit 

I  ON  14 

G0R08 

S/D  D8  Data  Bit 

I  ON  15 

G0R09 

S/D  D9  Data  Bit 

I  ON  16 

G0R10 

S/D  DIO  Data  Bit 

I0N17 

GOR 1 1 

S/D  Dll  Data  Bit 

I  ON  18 

Reserved 

I  ON  19 

Reserved 

I0N20 

Reserved 

I0N21 

Reserved 

I0N22 

Reserved 

IONA 

None 

+5  Volts  DC 

I ONB 

None 

Digital  Ground 

I ONC 

None 

-15  Volts  DC 

I OND 

None 

Analog  Ground 

I  ONE 

None 

+15  Volts  DC 

IONF 

C1B00 

AO  Address  Bit 

I ONH 

C1B01 

A1  Address  Bit 

IONJ 

C1B02 

A2  Address  3it 

IONK 

C1B03 

A3  Address  Bit 

I ONL 

Bus 

DO  Data  Bit 

IONM 

Bus 

D1  Data  Bit 

IONN 

Bus 

D2  Data  Bit 

I ONP 

Bus 

D3  Data  Bit 

I ONR 

Bus 

D4  Data  Bit 

IONS 

Bus 

D5  Data  Bit 

IONT 

Bus 

D6  Data  Bit 

I ONU 

Bus 

D7  Data  Bit 

IONV 

C1B31 

Read/Write  Control  Line 

10  NIT 

G0S42 

Angular  Velocity  Analog  Signal 

I ONX 

None 

Acceleration  Analog  Signal 

IONY 

None 

Acceleration  Ground 

I ONZ 

Unused 

E-6 


H89  to  GYRAC  RS-232  Cable 


89  Connector 
Pin  Number 


Signal 

Description 


GYRAC  Connector 
Pin  Number 


2 

3 

7 


Tx  Data 
Rx  Data 
Ground 


2 

3 

7 


Ground 


GYRAC  WIRING  HARNESS  (continued) 


(con 


C/fljV 


APPENDIX  F 


GYRAC.A  Structure  Chart  . . .  F-2 

GYRAC.A  Program  Listing  .  F-3 

GYRAC.A  Operating  Instructions  .  F-21 


F-1 


GYRAC.A  PROGRAM  LISTING  (continued) 


1  -■ 

•i  ■  ?  '  *  :• 

j 

v 

\  o.t*  .  T'  ./■ 

:  %  ■  j  ; 

:  >  r  r  ;  * 

•:  ■ 

;'v "-*r  2 

rv. 

*  4  4  _  L 

!  *■  j  4  *1  4  ‘ 

r 

2  i  .  *  s  o T  f'.-43ir  ; 

i '  :  .  t 

:  f  r  r  t 

•  if3 

:r-  iZ. 

5  r 

*  --*1:  :• 

:  =  >4  3  -»r-  J 

- 

i  b  1,  t4  -:  *  N44  3ir,i 

c 

:  ;  - 1 

:  l  it  '  4  t 

:  4'  3 

-il 

.  s  r 

• 

;?4*-3  4r.« 

T 

/  I  :  ^.te5  ■•  t  velocity 

J  r*  c- 

:  :  4 1 

:  '« j-  t  r.  -j--  t 

- 

r,.-  %r, 

-4 

•:  i  c~ 

I  r 

v  .*  i  1  i 

;  *  *  4  J  ^  r>  -3 

T 

1  t  s  1 4  ..'Is  velocity 

:  t 

:  0;t  r.  *  : •  t 

•: 

:•  *■  f  •■if  '3 

•  r 

c-oO 

t  r 

1  r  v*  1 

;  '  •  « -i  r  v  r  ’ 

c;t  j  TOr.surt 

-■  c’ 

1  •*' 

;  :--r  t  4  •  t 

C  r*/;»4r.ij 

£; 

:h 

l  5  * 

*  -  «  *  2  b 

:  F  ir  4  3  if  J 

T 

1  bytes  :  *  a  n  g  v*  1 

T  - 

.>'■  C 

l  "•  p-  •.  t 

:  »:•»  t  -  -  •  t 

: 

C-r  I'fi  r.  .3 

££'v 

£'ndl 

jSC 

a-e'lf 

;  c  a  -3  -i  r. 

T 

.<  1  b  -  *4  f  4  0  0  ve  1 

£  A, 

;r  D 

lr  b'J t 

:  vet  t 

4  0  j 

-  M 

c'  d-J 

t  5f 

-■  4*  1  :b 

:F'4a3  ar.tf 

T 

2  bytes  :  f  e  a  -3  i  n  3 

il 

.i  *  r 

t 

»rd 

v 

2  bytes  f  velocity 

:" 

.r>b 

;  noto  t 

: 0*t  04.  t 

r 

■j»f..'ii%r  <3 

19 

:  r,i  -3  v 

i  s  r 

*  *  *  -S  l  b 

;  c  4?  -a  3  4 r.  '1 

- 

l  byte  of  ■•443:''  o 

:  ^*40  ar  -i  T  1  b  y  t  * 


19  :r,v3K 


'  4  %  -3  l  b 
*  *  '  l  b 


:■  f  4  ^  2  i  r  .j 

:■  f  <« 


GYRAC.A  PROGRAM  LISTING  (continued) 


y  rr  r  eis:  si  jr.iricint  1 J  Mrs  .-r  t r. «  is 

si  jm  r  ;*%rt  • 

C-=;ED  VAPI-LLET:  \.'.e 

i.jtr:  •:  r  "pioir,.;  lata  '.»ritter.  to  AC  I A  '  R-G-l  ?C  > 
Gi-C-GAL  VARIANCE  •-•Hr:  Nr.e 
■GL-GEAl  VAR  I  AC  LES  CHANGED:  Nor.* 

=  E0 1 !•"£=!  !.«:£[:  A,  Gf 

-ILEI  -BITTEN: 

-CDULE:-  CmLLEIs  V- 

j  I  se 

“ALL INC-  *1-C‘!JLE?s  ^.axr, 

A  JThC'c  ;  C  AP  T  WILLIAM  J.  RAMEY  -jR. 

AI3TCPY:  Version  1.0  original 

Version  1.1  cr.ar.ge  heading  data  format 


2  A  $“ 

Q.  7  ?ci  ;> 


:d  e: 


r«*4d2t«  Ida*  Hheadao-jl 
staa  ciadataA 
.  *r  »c-'j  i  s* 

'  2*a  *'“•-4  3*  3  jh 

staa  ; iaoataA 
■•2»&  piadatai? 
j'r  t 

’  daa  •  r.eadadjl 


vet  address  of  Ls£  of  headirg 
Urite  LCD  Neadir;  address  to  GY 
vend  g>'PAC  'jirite  pulse  to  latch 
Oe t  address  of  M : D'  c  *  * e a d ;  r- g 

heading  ado- ess  t ■:  GY 
R«ad  M-s?  of  Neal; -g  «rr-  GYP  AC 
Send  MEG  of  heading  to  -CIA 
Ge  t  a  d  :  *  ;  s  s  of  -IB  ■:  r  h  «•  a  d  l  "•  o 


I'»  Z 


GYRAC.A  PROGRAM  LISTING  (continued) 


.  *  1  \  x, 
a  .  «  •  - : 
i : 

‘Vjt-op;  .:;pt  a  ill: am  ..  c^£'’  r . 

none 

i  4  A.;  I A  ( F.  - -LI;2 '  stat-js 

ir.-ii  «tir*  :  I  s  A-:  I A  far-snit  lata  '•er.st 

U'*,  -  ;  I  *  ’:•■:•  c  to  :  -  iri  r  *  : r e •: 

itat-  a:  .ada ta.  -.Else  t:%'  rut  :at*  ;  *•  -■  r*.: 


GYRAC.A  PROGRAM  LISTING  (continued) 


r  ^  4«  1  o  ^ 


:  h : ZE2 

:c"P.*N:g 

:-CEflw 

* 

^EOI  ;TE: 


:  all  I no 

* I  STOP V s 


■  -  :  re  .  2  .  -  i 

I  Or.:  ^  ?  t  r  :  s  a  ■••rite  ;41.«  f  .  -  ,  r  -■ 

••■s’  :  .  *  .  :  4  r  a  r  :  1  s  t  •  *  •:  ‘  •*  t  :  r.  -  -  4  2  a  :  i  .  '  .-i  j; 

t  ■  •  t  :  *  i  t  -■  t  •  :  t  y  J*ta,  '  •=  r  .*  • .  %  r  5  40-1  3  ?  ■  j  s 

r r. r  ; -i *  a  ,  ^ • :  - 1  «■ « t ,  t —  ::a  c  i  -  i  : ;  •  :  j  * . 

C  5,  rr  -  i* a  >  t  s  x  1  r  1  f  t  •;  4  r.  *  i  0  m  t  =  ,  r  t  r<~  3  *  t  %  is 

s  l  2"  ;  * ;  C4“.t . 

-PIADL£:;  v,r,* 

r-  :•  j :  .• r.  :*  v *’>>•:  1 1  j  -lata  •••ritten  to  A'!  A  ifiS-232) 
ARIAC-LtS  L:EC;  N * 

AP  IAOl-E  :  CiANOED.  N.:-n« 

1  Or  ED:  A,  S 

AO:  • 


>•  -:»a 

7  5  i/»  0  ^ 

d  £2  :: 

:«  £2  2E 


•  ;  *j  l  s 

Oi  4  J 

r."»ir. 

.  -AnEV  JF.. 

•  1 .  A 

(■**•**♦♦ 

r  ;  cj  1  r.  4  ! 
h  4Pi  G<&  v*1*3 

::  ty 

■24 1  4  *  :  p  '<4  t 

1  -344 

#  V  «  1  4  d  d  ft 

:  O*  t 

address  M*  **' 

S  t44 

£'  H  5iti^ 

;Wr  j  tt  v t  1  0 c  i  ■ 

i“ 

•C  >J  1  56 

rtr"3 

jYPhC  .*«r  ;  tr 

sr 

3^  Uy 

A  i  !  .. 

■u  *or  A  tc  0 

•  <34t 

:  !«  S»t*[ 

2  1  *  p-  e  ad 

S  f  4 1' 

t«rf  ; 

:  4  v  e 

-4-..  N:z  0-  ■ 

ISPS 

n. 

I  t  2 

4 

D  cZ  i? 


2  a  -a  » •.  e  I  a  •  j :  ’ 
t  aa  :  :  •*  3a  t  aA 
:u  ; lid 4  tie 


: * ■-■  -1  MS?  of  *  r-i  ; :  *.  3  t  :  £r  .*L 

'!■  r  t  423  -  sS5  •'  *  Lie  of  V  «  1  .  1 3  t  u 

Lr  i  t  i  L:Z  ,  «  1  Z ■  4  3  3  '  ?  S  =  T‘ 
:ra.j  L  •:• f  Tit-  fr  >  P- 


144  •  c  :  t  r  a-"  m'T t 

5  4  ;  mo  i  ,  ?  t  r  a 1,1 


f-12 


v  >  '.e.s-.evoV. 


- .  •  .  .  • ,  > .  V  .- 


r*  g* 


GYRAC.A  PROGRAM  LISTING  (continued) 


V  / 


GYRAC.A  PROGRAM  LISTING  (continued) 


AD-A164  826  GVRO  AND  ACCELEROMETER  BASED  NAVIGATION  SVSTEH  FOR  A  1/1 

NOBILE  AUTONOMOUS  RO  <U)  AIR  FORCE  INST  OF  TECH 
HRIGHT-PATTERSON  AFB  OH  SCHOOL  OF  ENGI 
UNCLASSIFIED  R  i  BLOOM  ET  RL  82  DEC  85  F/G  12/7  Nt 


rn  m  in 


GYRAC.A  PROGRAM  LISTING  (continued) 


'1  - 

».;i  a-;-.  2 

i  V 

x  a  -3  a  t  a 

'  l 

a  :  i  a r 

1  It 

e  : :  v 

a  v  tr  11: 

£  i  0  1 

a  v  «■  -  a  d  -3  h 

c..  j0 

t-fc-: :  n 

ec  : 

►.  H  i  :  p 

e:ef 

0  '  ■  •  c »  s 

: 

El 

.•  i 

*:  ,  t  ’  ■:  •  •  P 

E  1  F  1 

•;f  ar 

3 

.  4 

:•*  «r  '  o f 

e: 

1  r  .  *  t 

E .  C 1 

<::■  .4 

£  .'  i  :• 

*•2 

:r«  30 

E  1  ‘  £ 

E  .-4 

■:r..  3£ 

E'.'44 

1  •• 

e:  tv 

.;r,  :  H 

£•.  tO 

:•>  -3 1 

E'r'C  1 

.*•1  : 

I'n  2  ► 

EC  1 1 

£•'  r  - 

:  .  i“! 

1C  DC' 

F.  / 

.* 

•;  <;,4 : 

c 

»X'4  2 

-  •• 

4  4 

•;  :•«■<»£ 

»:■ ; 

.•  -vr,  C 

r,;'4c- 

..4  7 

C  O'  iH 

'  C1 4 

•:  ;-r  ■  I 

•:>  .4? 

:  :-?»  j 

$0.4  A 

:-4E 

c  y..L 

■**  l. 

•;  gf  * 

c 

M--4E 

;4- 

gt-Uu 

Ell'E 

3«  to :  r.« 

EC  Er 

*■  *aai  t 

Ell? 

.'r  h 

1  a  d  d  b 

:  CC  £ 

f.ea  ja  3  3 1 

0:*  F 

in;  t 

ECO* 

£10'  * 

r 

£>•'4 

p  :  a  •:  z  r  1 A 

1 

■*iO  7 

C  ;  aoa tiM 

•f  »i  rr.S 

? :  a -3 a  tat 

c-  tri 

EC';  A 

,  *4 

p  t'i  :ru<3 

p  t  t 

.‘1  ^ 

:■  t  "-C  t  r  i  l 

L  >X*! 

.  1 

P t  N  t 

c  c  z- 

-  a:,  bo t 

r  -i~  r 

1 

:  Fi 
X’t 

£  C  4  :  r 

test 

V  *  1  l  & 

'•'PM  I  5  6 

4-7  “F 
E10  1 

E 1  74 

r  5 

tx 

v*  1  2  b 
■■ir  1 1  e 

El  41 

4 

?  3r  * 

r  s  a  3  d 

v  a  i  a  d  -3  b 

OC-M 

£0  $>A 

F-20 


w  fit* 


GYRAC.A  OPERATING  INSTRUCTIONS 


STEP  1 :  Power  up  the  H89  computer  system.  Place  the  System 
disk  in  Drive  A  and  the  gyro  program  disk  in  Drive  B.  Boot 
the  system  (type  "B  29")  and  change  the  mode  of  Drive  B  to 
single  sided  double  density  (type  "mode  B:ss,dd").  Change 
the  working  drive  to  Drive  B  (type  "B:"). 

STEP  2:  Connect  the  H89  to  GYRAC  RS-232  cable  between  the 
H89  DCE  connector  and  the  MARRS-1  GYRAC  Computer  connector. 
Connect  the  external  power  cable  to  the  GYRAC  and  turn  on 
the  power  supplies.  Flip  the  GYRAC  power  switch  to  the  on 
position  and  press  the  GYRAC  computer  reset  button.  Flip 
the  gyro  control  switch  to  the  slaved  mode  for  automatic 
tracking  or  the  free  mode  for  manual  heading  changes. 

STEP  3:  Load  and  run  the  M72  modem  program  on  the  H89  by 
typing  "M72".  When  this  program  is  running  type  "T"  to 
enter  the  M72  Terminal  mode.  Set  the  H89  keyboard  caps  lock 
on. 

STEP  4:  Commands  may  now  be  issued  to  the  GYRAC.  They 
consist  of  single  character  capital  letters  from  A  thru  0 
inclusive.  The  resulting  hexidecimal  data,  as  detailed 
below,  is  displayed  (if  it  is  printable)  on  the  CRT.  NOTE: 
Not  all  data  returned  is  printable,  so  some  results  may  not 
be  displayed.  Repeat  STEP  4  as  often  as  desired. 


COMMAND 


RESULT 


A 


B 


C 

D 


E 


F 


Two  bytes  of  heading  data  (12  valid  bits) 

Two  bytes  of  velocity  data  (10  valid  bits) 

Two  bytes  of  angular  velocity  data  (10  valid  bits) 

One  byte  of  heading  data  (8  valid  bits) 

One  byte  of  velocity  data  (8  valid  bits) 

One  byte  of  angular  velocity  data  (8  valid  bits) 

Two  bytes  of  heading  data  (12  valid  bits) 

One  byte  of  heading  data  (8  valid  bits) 

Two  bytes  of  velocity  data  (10  valid  bits) 

One  byte  of  velocity  data  (8  valid  bits) 


G  Clear  velocity  constant  (no  data  returned) 
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GYRAC.A  OPERATING  INSTRUCTIONS  (continued) 


Two  bytes  of  angular  velocity  data  (10  valid  bits) 

One  byte  of  angular  velocity  data  (8  valid  bits) 

Two  bytes  of  heading  data  (12  valid  bits) 

Two  bytes  of  velocity  data  (10  valid  bits) 

One  byte  of  heading  data  (8  valid  bits) 

One  byte  of  velocity  data  (8  valid  bits) 

Soft  reset  of  GYRAC  computer  (no  data  returned) 

Boot  load  a  program  from  the  H89  into  RAM  and  then 
execute  to  loaded  program.  No  data  is 
returned  unless  the  user  program  sends  it. 

Control  is  not  automatically  returned  to 
the  GYRAC  control  program,  but  is  at  the  mercy 
of  the  boot  program. 

Returns  93  printable  ASCII  characters 
This  tests  the  communications  link 

One  byte  of  heading  data  (8  valid  bits) 

Two  bytes  of  velocity  data  (10  valid  bits) 


STEP  6:  Shutdown  all  systems.  Type  "control  shift  " 

followed  by  "control  E"  to  exit  Terminal  mode.  To  exit  M72, 
type  "CPM".  Remove  both  disks  from  the  drives  and  turn  of 
the  power  to  the  H89  system.  Turn  off  power  to  the  GYRAC 
and  external  power  supplies. 

NOTE:  All  references  to  "control"  and  "shift"  in  the  H89 

command  lines  refer  to  the  control  and  shift  keys  and  not 
the  words  control  and  shift.  It  is  assumed  that  the  robot 
has  been  "pointed"  to  the  desired  initial  heading  before 
testing  commences  or  that  the  gyro  free  mode  will  be  used  to 
vary  the  heading. 
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GTEST.A  OPERATING  INSTRUCTIONS 


STEP  1 :  Power  up  the  H89  computer  system.  Place  the  System 
disk  in  Drive  A  and  the  gyro  program  disk  in  Drive  B.  Boot 
the  system  (type  "B  29")  and  change  the  mode  of  Drive  B  to 
single  sided  double  density  (type  "mode  B:ss,dd").  Change 
the  working  drive  to  Drive  B  (type  "B:"). 

STEP  2:  Power  up  the  MARRS-1  Robot.  Make  sure  the 
batteries  are  fully  charged  and  the  charger  power  line  is 
connected  and  turned  on.  Press  both  the  system  reset  key  on 
the  keypad  and  the  Nav  computer  reset  button. 

STEP  3 :  Load  and  run  the  M72  modem  program  on  the  H89  by 

typing  "M72" .  When  this  program  is  running  type  "SPD"  to 
change  the  transmission  time  delays.  When  prompted  for  time 
delays  reply  with  a  "1"  for  both  character  and  line  delay 
times.  Set  the  H89  keyboard  caps  lock  on. 

STEP  4:  Connect  the  H89  to  Robot  RS-232  cable  between  the 

H89  DCE  connector  and  the  MARRS-1  Nav  T  connector.  Connect 
the  GYRAC  to  Nav  Computer  RS-232  cable  between  the  GYRAC 

connector  and  the  Nav  L  connector  on  MARRS-1.  Connect  the 
teaching  pendant  cable  to  MARRS-1.  Connect  the  external 
power  cable  to  he  GYRAC  and  turn  on  the  power  supplies. 
Flip  the  GYRAC  power  switch  to  the  on  position  and  press 

the  GYRAC  computer  reset  button.  Flip  the  gyro  control 
switch  to  the  slaved  mode. 

STEP  5:  Load  and  transmit  the  GTEST.HEX  file  to  the  robot's 
navigation  computer.  This  is  done  by  typing  "L, 02FA, 03E9" 
to  load  the  file  at  Nav  computer  memory  address  02FA  (HEX). 
Next  type  "T  filename".  This  will  place  the  CRT  in  terminal 
mode  and  create  an  input  buffer  to  store  incoming  data  in 
disk  file  filename.  Follow  this  by  typing  "control  shift  " 
then  "control  T"  and  "GTEST.HEX"  to  transmit  thg  program 
file  to  the  Nav  computer.  Reply  with  Yes  when  asked  for 
time  delays.  The  program  data  will  be  displayed  as  it  is 
transmitted.  If  an  error  is  made  in  STEP  5,  the  navigation 
reset  button  must  be  pressed  and  the  entire  step  done  over. 

STEP  6:  Begin  program  execution.  First  type  "control  shift 
"  and  then  "control  Y"  to  open  the  input  data  buffer.  Now 
type  "C"  to  begin  program  execution.  Next  steer  the  robot 

using  the  teaching  pendant  (MARRS-1  manual  mode,  4)  along 

the  desired  course.  During  program  execution  the  robot  will 
send  optical  shaft  encoder  data,  heading  data,  angular 
velocity  data,  and  velocity  data  at  0. 1  second  time 
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intervals  to  the  H89  computer.  This  data  will  be  displayed 
on  the  CRT  and  stored  in  the  input  buffer. 

STEP  7:  When  the  robot  run  is  completed  (i.e.  you  have 

manually  stopped  it  with  the  MARRS-1  system  reset  button) 
the  data  stored  in  the  input  buffer  may  be  written  to  disk. 
To  do  this  press  the  Nav  Computer  reset  button  on  MARRS-1 
and/or  type  "control  C"  on  the  H89.  Next  type  "control 
shift  "  followed  by  "control  E".  Now  type  "WRT"  to  save 
the  data  to  disk  ("del"  may  also  be  typed  to  dump  buffered 
data).  If  additional  runs  are  required  continue  with  STEP  5 
and  press  all  three  MARRS-1  reset  buttons. 

STEP  8:  Shutdown  all  systems.  To  exit  M72,  type  "CPM". 

Remove  both  disks  from  the  drives  and  turn  of  the  power  to 
the  H89  system.  Turn  off  power  to  the  robot,  GYRAC,  and 
external  power  supplies. 

NOTE:  All  references  to  "control"  and  "shift"  in  the  H89 
command  lines  refer  to  the  control  and  shift  keys  and  not 
the  words  control  and  shift.  Care  must  be  taken  to  ensure 
the  various  cables  to  MARRS-1  do  not  become  tangled  during 
movement.  In  addition,  it  is  assumed  that  the  robot  has 
been  "pointed"  to  the  desired  initial  heading  before 
movement  commences.  The  actual  direction  of  travel  is  human 
controlled  from  the  teaching  pendant.  Also,  the  GTEST.HEX 
program  must  be  loaded  each  time  a  run  is  attempted,  since 
the  program  is  cleared  on  navigation  computer  reset  or  by  a 
"control  C"  in  M72  Terminal  mode. 


G-12 


1  w  *  M  •  L  * 


►v  ^ VV 


¥  M  ' 

«  *  >  •»  »  “ 


APPENDIX  H 


NAV.A  Structure  Charts  .  H-2 

NAV.A  Program  Listing  .  H-5 

MARRS.NAV  Program  Listing  .  H-26 

NAV.A  Operating  Instructions  .  H-27 


K-1 


;  ORWARD 


NAV.A  PROGRAM  LISTING  (continued) 


iii  y 


n  o> 


NAV.A  PROGRAM  LISTING  (continued) 


*  «  ««  jo***»-***«  •*««♦«'»»«  ***■>««  •  »« 


E:  'li  /Sf. 

=  T  t  N :  i .  C’ 

•E :  r  :  ^t.t 

’.LE  N"  •*£  Er. :  1  .  f 

:ipI?Ti:rj;  >  i;  :c--;3  a  r 

if  t  :  t *« £  ? 

:e:  .-piaele:: 

!_P  Nor* 

:-^L  VhP  I A2  _E  ~-  L  j-ED?  ' < •:  "  ■? 

:-l  var:  ;cle=-  chanced: 

Ei  =EAD:  N-r.* 

E:  ^I^TEN:  No  '■« 

LLE  E  CALLED:  Slf'ij,  ’  Uv,  .  S-s-r.  1 

LlNC  *,:CZ»ULEi:  £ 

l:'  :  :a=t  a  :: ia>i  =  a^e--'  . c-. 


Mat-  *  A' 

e  t  ir 

jsr  s  j • »  4  y 

Mat)  ** '  L 
.  sr  se<-.-i 

^  5  r  iic’iy 

Ma:  «  > 

..  3  .*  i  t  r.  0  .■ 
j  S  r  5  •]  tf  1  4  s 


Mat  #  1  ’ 

5  r  S«r.  3, 

, sr  Me  '  a  , 

Ma:  *  * 

.  3  e  M  • 

5 r  «.  r r  ay 

’  •  ' 


it-'-J  t?  3 “  i  v *  ■::■•■  c-.-r^r  •**£'.  !«■= 

"  :  rt  t.rr  ::rt:-,-.j5  c  :*-■•■  a r-i 
« *  q  .  *  r, :  * 


H-16 


NAV.A  PROGRAM  LISTING  (continued) 


NAV.A  PROGRAM  LISTING  (continued) 


i*c  «*  1  ' 


MARRS.NAV  PROGRAM  LISTING 


Address  (HEX) 

Instruction  Code  (HEX) 

Comment 

NONE 

AA 

Put  MARRS-1  into 

NONE 

01 

Instruction  Input 

NONE 

00 

Mode  at  Address  0100 

0000 

CC 

Start  Drive  Motor 

0101 

IB 

Forward  at  Fast 

0102 

FF 

Speed  (movef) 

0103 

3A 

0004 

03 

Turn  Steering  Motor 

0105 

DC 

One  Increment  to  the 

0106 

EC 

Left  (left) 

0107 

01 

0108 

3A 

0009 

03 

Turn  Steering  Motor 

0 10A 

DC 

One  Increment  to  the 

01  OB 

E8 

RIGHT  (right) 

010C 

01 

0 1 0D 

3A 

0 1 0E 

03 

Turn  Steering  Motor 

0 10F 

CC 

to  the  Center, 

0110 

E8 

straight.  Position 

0111 

49 

(center) 

0112 

3A 

0113 

03 

Turn  Steering  Motor 

0114 

CC 

to  the  Full  Right 

0115 

E8 

Position  (rotr) 

0116 

90 

0117 

3A 

0118 

02 

Stop  all  Motor 

0119 

03 

Movement  (stop) 

01 1A 

3A 

01  OB 

CC 

Start  Drive  Motor 

010C 

13 

Forward  at  Medium 

0  1 0D 

FF 

Speed  (movem) 

0  1 0E 

3A 

01  IF 

03 

Turn  Steering  Motor 

0120 

CC 

to  the  Full  Left 

0121 

EC 

Position  (rotl) 

0122 

00 

0123 

3A 

NONE 

R 

Reset  to  Input  Mode 

NAV.A  OPERATING  INSTRUCTIONS 


STEP  1 :  Power  up  the  H89  computer  system.  Place  the  System 
disk  in  Drive  A  and  the  gyro  program  disk  in  Drive  B.  Boot 
the  system  (type  "B  29”)  and  change  the  mode  of  Drive  B  to 
single  sided  double  density  (type  "mode  B:ss,dd").  Change 
the  working  drive  to  Drive  B  (type  "B:"). 

STEP  2:  Connect  the  H89  to  Robot  RS-232  cable  between  the 

H89  DCE  connector  and  the  MARRS-1  Drive  Computer  (MENOS) 
connector.  Power  up  the  MARRS-1  Robot.  Make  sure  the 
batteries  are  fully  charged  and  the  charger  power  line  is 
connected  and  turned  on.  Press  both  the  system  reset  key  on 
the  keypad  and  the  Nav  computer  reset  button. 

STEP  3:  Load  and  run  the  M72  modem  program  on  the  H89  by 

typing  "M72" .  When  this  program  is  running  type  "SPD"  to 
change  the  transmission  time  delays.  When  prompted  for  time 
delays  reply  with  a  "1"  for  both  character  and  line  delay 
times.  Set  the  H89  keyboard  caps  lock  on. 

STEP  4:  Load  and  transmit  the  MARRS. NAV  file  to  the  robot's 
Drive  computer.  This  is  done  by  typing  "T"  to  enter  the  M72 
Terminal  mode.  Next  type  "control  shift  "  followed  by 

"control  T"  and  then  "MARRS . NAV"  to  send  the  program  file. 
When  asked  if  time  delays  are  desired,  answer  Yes.  The  file 
will  be  displayed  as  it  is  being  transmitted.  When  it  is 
finished  you  will  see  the  data  stop  and  hear  the  robot  say 
"READY".  Type  "control  shift  "  followed  by  "control  T"  to 
return  to  the  M72  command  mode.  This  entire  step  can  be 
skipped  if  the  program  is  hand  keyed  directly  into  MARRS-1 
via  the  onboard  keypad  (which  is  the  recommended  way  since 
it  avoids  moving  cables),  NOTE:  MARRS-1  system  resets  do 

not  erase  this  program. 

STEP  5:  Connect  the  H89  to  Robot  RS-232  cable  between  the 

1189  DCE  connector  and  the  MARRS-1  Nav  T  connector.  Connect 
the  Drive  Computer  to  Nav  Computer  RS-232  cable  between  the 
Drive  Computer  connector  and  the  Nav  X  connector  on  MARRS-1. 
Connect  the  GYRAC  to  Nav  Computer  RS-232  cable  between  the 
GYRAC  connector  and  the  Nav  L  connector  on  MARRS-1.  Connect 
the  external  power  cable  to  the  GYRAC  and  turn  on  the  power 
supplies.  Flip  the  GYRAC  power  switch  to  the  on  position 
and  press  the  GYRAC  computer  reset  button.  Flip  the  gyro 
control  switch  to  the  slaved  mode. 

STEP  6:  Load  and  transmit  the  NAY. HEX  file  to  the  robot's 

navigation  computer.  This  is  done  by  typing  "L, 1000, 1369" 


NAV. A  OPERATING  INSTRUCTIONS  (continued) 


to  load  the  file  at  Nav  computer  memory  address  1000  (HEX). 
Next  type  "T  filename".  This  will  place  the  CRT  in  terminal 
mode  and  create  an  input  buffer  to  store  incoming  data  in 
disk  file  filename.  Follow  this  by  typing  "control  shift  " 
then  "control  T"  and  "NAV. HEX"  to  transmit  the  program  file 
to  the  Nav  computer.  Reply  with  Yes  when  asked  for  time 
delays.  The  program  data  will  again  be  displayed  as  it  is 
transmitted.  If  an  error  is  made  in  STEP  6,  the  navigation 
reset  button  must  be  pressed  and  the  entire  step  done  over. 

STEP  7:  Begin  program  execution.  First  type  "control  shift 
"  and  then  "control  Y"  to  open  the  input  data  buffer.  Now 
type  "G, 1000"  to  begin  program  execution.  During  execution 
time  the  robot  will  send  to  the  H89  two  bytes  of  heading 
data  each  time  it  considers  a  course  change.  This  data  will 
be  displayed  on  the  CRT  and  stored  in  the  input  buffer. 

STEP  8:  When  the  robot  run  is  completed  (i.e.  you  have 

manually  stopped  it  with  the  MARRS-1  system  reset  button) 
the  data  stored  in  the  input  buffer  may  be  written  to  disk. 
To  do  this  press  the  Nav  Computer  reset  button  on  MARRS-1. 
Next  type  "control  shift  "  followed  by  "control  E".  Now 
type  "WRT"  to  save  the  data  to  disk  ("del”  may  also  be  typed 
to  dump  buffered  data).  If  additional  runs  are  required 

continue  with  STEP  6  and  press  all  three  reset  buttons  on 
:JARRS-  1 . 

STEP  9:  Shutdown  all  systems.  To  exit  M72,  type  "CPM". 

Remove  both  disks  from  the  drives  and  turn  of  the  power  to 
the  H89  system.  Turn  off  power  to  the  robot,  GYRAC,  and 
external  power  supplies. 

NOTE:  All  references  to  "control"  and  "shift"  in  the  H89 
command  lines  refer  to  the  control  and  shift  keys  and  not 
the  words  control  and  shift.  Care  must  be  taken  to  ensure 
the  various  cables  to  MARRS-1  do  not  become  tangled  during 
movement.  In  addition,  it  is  assumed  that  the  robot  has 
been  "pointed"  to  the  desired  initial  heading  before 
movement  commences.  The  actual  direction  of  travel  is  set 
into  the  NAV. A  program  at  assembly  time.  Also,  the  NAV. HEX 
program  must  be  loaded  each  time  a  run  is  attempted,  since 
the  program  is  cleared  on  navigation  computer  reset. 
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REM*  *  ******************************************************* 


REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 


* 

DATE:  30SEP85  * 

VERSION:  1.0  * 

TITLE:  CONVERT  * 

FILENAME:  CONVERT. BAS  * 

AUTHOR:  CAPT  ROLAND  J.  BLOOM  * 

PROJECT:  GYRO  AND  ACCELEROMETER  BASED  NAVIGATION  * 

SYSTEM  FOR  A  MOBILE  AUTONOMOUS  ROBOT  * 

(THESIS)  * 

OPERATING  SYSTEM:  Z89/Z90  CP/M  V2.242  MAGNOLIA  * 

MICROSYSTEM  1982  * 

LANGUAGE:  MBAS I C  * 

USE:  This  program  is  used  to  convert  raw  hex-  * 


adecimal  data  obtained  from  the  NAV  computer  * 
into  integer  data.  The  whole  data  string  * 
is  read  and  converted  to  integer  format.  * 
The  program  interactively  asks  for  the  name  * 
of  the  hex  data  file  and  asks  for  the  name  * 
of  the  file  where  the  integer  data  is  to  be  * 
stored.  * 

* 


REM********************************************************* 


REM*  * 
REM*  MAIN  PROGRAM  * 
REM*  * 


REM* 

10  PRINT  "INPUT  THE  NAME  OF  THE  HEX  DATA  FILE  TO  CONVERT" 

20  INPUT  "INCLUDE  THE  DISK  DRIVE  AND  ENCLOSE  IN  QUOTES" , READF I LE$ 
30  PRINT  "  " 

40  PRINT  "INPUT  THE  NAME  OF  THE  FILE  TO  STORE  THE  INTEGER  DATA" 

50  INPUT  "INCLUDE  THE  DISK  DRIVE  AND  ENCLOSE  IN  QUOTES" , PRINTFILES 
60  OPEN  " I " , # 1 , READF I LE$ 

70  OPEN  "0" ,#2, PRINTFILE$ 

REM* 

REM*  A  DATA  STRING  IS  READ  AND  THEN  EACH  DATA  SEGMENT  IS 

REM*  CONVERTED  AND  STORED  ON  DISK 

REM* 

80  I NPUT# 1 , DATAL I NE$ 

90  IF  EOF( 1 )  THEN  END 

100  WORDS  =  MID$ ( DATALINE$ ,3,4) 

1 10  GOSUB  300 

120  PRINT#2, VALUE%, ", " ; 

130  FOR  1%  =  11  TO  26  STEP  5 
140  WORDS  =  MID$ ( DATAL INE$, 1%, 4) 

150  GOSUB  300 
160  GOSUB  450 
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170  NEXT  1% 

180  FOR  1%  =  40  TO  47  STEP  7 
190  WORDS  =  MID$(DATALINE$ , 1%, 4) 

200  GOSUB  300 
210  GOSUB  450 
220  NEXT  1% 

230  GOTO  80 

REM*  *  ******************************************************* 
REM*  * 

REM*  SUBROUTINES  FOLLOW  * 

REM*  * 

REM********************************************************* 
REM* 

REM*  THIS  SUBROUTINE  CONVERTS  THE  HEX  VALUE  TO  INTEGER 
REM* 

300  VALUE%  =  0 

310  FOR  J  =  2  TO  4 

320  CHARS  =  MID$ ( WORDS , J%> 1 ) 

330  DIGIT  =  VAL( CHARS ) 


340 

IF 

CHARS 

= 

"A" 

THEN 

DIGIT  = 

10 

350 

IF 

CHARS 

= 

"B" 

THEN 

DIGIT  = 

1 1 

360 

IF 

CHARS 

= 

"C" 

THEN 

DIGIT  = 

12 

370 

IF 

CHARS 

= 

"D" 

THEN 

DIGIT  = 

13 

380 

IF 

CHARS 

= 

"E" 

THEN 

DIGIT  = 

14 

390 

IF 

CHARS 

upti 

THEN 

DIGIT  = 

15 

400 

VALUE%  - 

VALUE% 

*  16 

+  DIGIT 

410  NEXT  J% 

420  RETURN 
REM* 

REM*  THIS  SUBROUTINE  STORES  THE  INTEGER  VALUES  ON  DISK 
REM* 

450  IF  1%  =  47  GOTO  480 
460  PRINTS,  VALUE%, 

470  GOTO  490 

480  PRINT#2, VALUE% 

490  RETURN 
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REM** 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM** 

REM* 

REM* 

REM* 

REM** 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 

REM* 


******************************************************* 

* 

DATE:  30SEP85  * 

VERSION:  1.0  * 

TITLE:  POSITION  * 

FILENAME:  POSITION. BAS  * 

AUTHOR:  CAPT  ROLAND  J.  BLOOM  * 

PROJECT:  GYRO  AND  ACCELEROMETER  BASED  NAVIGATION  * 

SYSTEM  FOR  A  MOBILE  AUTONOMOUS  ROBOT  * 

(THESIS)  * 

OPERATING  SYSTEM:  Z89/Z90  CP/M  V2.242  MAGNOLIA  * 

MICROSYSTEM  1982  * 

LANGUAGE:  MBAS I C  * 

USE:  This  program  is  used  to  compute  the  position  * 

of  the  MARRS-1  robot  based  on  heading  and  * 

velocity  data  from  the  GYRAC.  The  raw  data  * 
from  the  NAV  computer  (which  gathers  the  * 

GYRAC  data)  must  first  be  converted  to  * 

integer  format  by  the  CONVERT  program.  * 

The  computed  position  will  be  in  terms  of  * 

x  and  y  coordinates.  An  initial  (x,y)  * 

position  is  provided  to  the  program  * 

interactively.  Program  output  is  sent  * 

to  the  printer  where  time,  x-coordinate  * 

and  y-coordinate  are  printed.  * 

* 

*****************************************************,„* 

★ 

DEFINITION  OF  VARIABLES  * 


************ 


**************** 


X  =  X-COORDINATE  * 

Y  =  Y-COORDINATE  * 

DELTAX  =  INCREMENT  OF  MOVEMENT  IN  X-DIRECTION  * 

DELTAY  =  INCREMENT  OF  MOVEMENT  IN  Y-DIRECTION  * 

DISTANCE  =  LINEAR  DISTANCE  TRAVELLED  IN  T  SECONDS  * 
T  =  0.1  SECONDS  (WHICH  IS  THE  SAMPLE  TIME)  * 
HEADING  =  THE  HEADING  OF  THE  ROBOT  IN  DEGREES  * 

VELOCITY  =  THE  VELOCITY  OF  THE  ROBOT  (FT/SEC)  * 

WEIGHT  =  WEIGHT  OF  EACH  BIT  OF  VELOCITY,  * 

1024  BITS  REPRESENT  10  VOLTS  * 

THEREFORE  WEIGHT  =  0.00977  VOLTS/BIT  * 
CONV  =  CONVERSION  FACTOR  FOR  CONVERTING  THE  * 
VELOCITY  MEASUREMENT  FROM  VOLTS  TO  * 

FT/SEC.  THIS  VALUE  IS  BASED  ON  LOCAL  * 
ACCELERATION  DUE  TO  GRAVITY  OF  32.174  * 

FT/S/S/G  AND  THE  SENSITIVITY  OF  THE  * 

ACCELEROMETER  (VOLTS/G).  * 
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REM*  GF  =  GAIN  FACTOR.  THIS  IS  THE  GAIN  IN  THE  * 


REM*  INTEGRATOR  CIRCUIT.  * 
REM*  TIME  =  TIME  OF  MEASUREMENT  (SECONDS)  * 
REM*  RAWTIME  =  INTEGER  VALUE  OF  TIME.  THIS  VALUE  IS  * 
REM*  A  FACTOR  OF  10  TIMES  THE  REAL  TIME.  * 
REM*  RAWVEL  =  INTEGER  VALUE  FOR  VELOCITY  (BITS)  * 
REM*  RAWHEAD  =  INTEGER  VALUE  FOR  HEADING  (BITS)  * 
REM*  LEFTREV  =  REVERSE  WHEEL  COUNTS  FROM  OPTICAL  * 
REM*  SHAFT  ENCODER  ON  LEFT  REAR  WHEEL.  * 
REM*  LEFTFOR  =  FORWARD  WHEEL  COUNTS  FROM  OPTICAL  * 
REM*  SHAFT  ENCODER  ON  LEFT  REAR  WHEEL.  * 
REM*  RIGHTREV  =  REVERSE  WHEEL  COUNTS  FROM  OPTICAL  * 
REM*  SHAFT  ENCODER  ON  RIGHT  REAR  WHEEL.  * 
REM*  RIGHTFOR  =  FORWARD  WHEEL  COUNTS  FROM  OPTICAL  * 
REM*  SHAFT  ENCODER  ON  RIGHT  REAR  WHEEL.  * 
REM*  * 
REM*  NOTE  -  WHEEL  COUNTS  ARE  NOT  USED  BY  THIS  * 
REM*  PROGRAM  BUT  COULD  BE  INCORPORATED  * 
REM*  TO  PROVIDE  A  SEPARATE  POSITION  * 
REM*  CALCULATION.  * 
REM*  * 
REM  ********************************************************* 
REM*  * 
REM*  MAIN  PROGRAM  FOLLOWS  * 
REM*  * 
REM*  ******************************************************** 
REM* 


10  INPUT  " INPUT  THE  NAME  OF  THE  DATA  FILE( INCLUDE  DISK  DRIVE)” 
FILES 

20  OPEN  "I”, #1 , FILES 
30  WEIGHT  =  0.00977 
33  CONV  =  32.174/0.6 
37  GF  =  1/19.7 

39  T  =  0.1 

40  INPUT  "INPUT  THE  INITIAL  POSITION  (X,Y)  IN  FEET,X0,Y0 
50  X  =  XO 

60  Y  =  YO 

70  INPUT  "INPUT  THE  TEST  DESIGNATION" , TESTS 
80  LPRINT  TESTS 
90  LPRINT  "  " 

100  LPRINT  "  POSITION" 

110  LPRINT  "  T I ME (SEC)  X(FT)  Y (FT) " 

120  LPRINT  "***********  ********  ******* 

130  LPRINT  "  " 

140  I NPUT# 1 , RAWT I ME , LEFTREV , LEFTFOR , R I GHTREV , R IGHTFOR , RAWVEL , 
RAWIIEAD 

150  IF  EOF( 1 )  THEN  END 
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160  TIME  =  RAWTIME  *  0.1 
165  PRINT  TIME 

170  VELOCITY  =  ( RAWVEL  -  512)  *  WEIGHT  *  CONV  *  GF 

180  HEADING  =  RAWHEAD  *  0.001534 

190  DISTANCE  =  VELOCITY  *  T 

200  DELTAX  =  DISTANCE  *  COS (HEADING) 

210  DELTAY  =  DISTANCE  *  SIN (HEADING) 

220  X  =  X  +  DELTAX 
230  Y  =  Y  +  DELTAY 

240  LPRINT  USING  "  ###.#  ##. ##" ; TIME, X, Y 

250  GOTO  140 


APPENDIX  K 


Phase  III  Test  Data 

Gyro  Navigation  Test  Run  Number  1  . 

Gyro  Navigation  Test  Run  Number  2  . 

Gyro  Navigation  Test  Run  Number  3  . 


GYRO  NAVIGATION  TEST  RUN  NUMBER  1 


Given:  33  Foot  Course 

Heading  of  3EC  (hex)  =  1004  (integer)  =  88.2421875 
(degrees) 


Steering  Window:  3E0 

to 

3EF  (Hex) 

992 

to 

1007  (integer) 

87. 1875 

to 

88.50585938  (Degrees) 

Measured:  Heading  at  each  course  change  decision  point 


HEADING  HEADING  HEADING  DEVIATION  DEVIATION 
(Hex)  (Integer)  (Degrees)  (Integer)  (Degrees) 


1003 

88. 15429688 

-  1 

-0.087890625 

3EB 

1003 

88. 15429688 

-  1 

-0.087890625 

3EB 

1003 

88. 15429688 

-  1 

-0.087890625 

401 

1025 

90.08789063 

+21 

+1.845703125 

410 

1040 

91.40625 

+36 

+3. 1640625 

40F 

1039 

91.31835938 

+35 

+3.076171875 

3FF 

1023 

89.91210938 

+  19 

+1. 669921875 

3D8 

984 

86.484375 

-20 

-1. 7578125 

3B0 

944 

82.96875 

-60 

-5.2734375 

3A2 

930 

81.73828125 

-74 

-6.50390625 

3A2 

81.73828125 

-74 

-6.50390625 

3B8 

952 

83.671875 

-52 

-4.5703125 

992 

87. 1875 

-12 

-1.0546875 

3FF 

89.91210938 

+  19 

+1. 669921875 

40D 

91. 14257813 

+33 

+2.900390625 

410 

1040 

91.40625 

+36 

+3. 1640625 

3FC 

89.6484375 

+  16 

+1. 40625 

3DB 

987 

86.74804688 

-17 

-1. 494140625 

3B9 

953 

83.75976563 

-51 

-4.482421875 

3AE 

942 

82.79296875 

-62 

-5.44921875 

3AA 

938 

82.44140625 

-66 

-5.80078125 

3BA 

954 

33.84765625 

-50 

-4.39453125 

3E2 

994 

87.36328125 

-10 

-0.87890625 

3FF 

89.91210938 

+  19 

+1. 669921875 

40A 

90. 87890625 

+30 

+2.63671875 

GYRO  NAVIGATION  TEST  RUN  NUMBER  2 


Given:  33  Foot  Course 

Heading  of  3 EC  (hex)  =  1004  (integer)  =  88.2421875 
(degrees) 


Steering  Window:  3E0 


3E0 

to 

3EF  (Hex) 

992 

to 

1007  (Integer) 

87. 1875 

to 

88.50585938  (Degrees) 

Measured:  Heading  at  each  course  change  decision  point 


HEADING  HEADING  HEADING 
(Hex)  (Integer)  (Degrees) 


66.53320313 

88. 15429688 

88. 15429688 

88.  15429688 

88.  15429688 

88. 15429688 

88.  15429688 

88. 15429688 

87.80273*38 

87.80273438 

87.80273438 

87.5390625 

87.27539063 

87.01171875 

87.36328125 

87.890625 

87.890625 

87.890625 

87.890625 

87.890625 

87.890625 

87.890625 

87.890625 

87.890625 

87. 890625 

87.80273438 

87.30273438 


DEVIATION 
( Integer) 


DEVIATION 

(Degrees) 


21.70898438 

0.087890625 

0.087890625 

0.087890625 

0.087890625 

0.087890625 

0.087890625 

0.087890625 

0.439454125 

0.439454125 

0.439454125 

0.703125 

0.966796875 

1.230468^5 

0.87890625 

0.3515625 

0.3515625 

0.3515625 

0.3515625 

0.3515625 

0.3515625 

0.3515625 

0.3515625 

0.3515625 

0.3515625 

0.439454125 

0.439454125 


GYRO  NAVIGATION  TEST  RUN  NUMBER  3 


Given:  33  Foot  Course 

Heading  of  3EC  (hex)  =  1004  (integer)  =  88.2421875 
(degrees) 


Steering  Window:  3e0 

to 

3EF  (Hex) 

992 

to 

1007  (Integer) 

87. 1875 

to 

88.50585938  (Degrees) 

Measured:  Heading  at  each  course  change  decision  point 


HEADING 

(Hex) 

HeADING 
( Integer) 

HEADING 

(Degrees) 

DEVIATION 
( Integer) 

DEVIATION 

(Degrees) 

502 

1282 

1 12.6757813 

+278 

+24.43359375 

3E4 

996 

87.5390625 

— 

8 

— 

0. 703125 

3E1 

993 

87. 27539063 

— 

1 1 

— 

0.966796875 

3E1 

993 

87. 27539063 

— 

1 1 

- 

0.966796875 

3E5 

997 

87.62695313 

— 

7 

- 

0.615234375 

3E8 

1000 

87.890625 

- 

4 

- 

0.3515625 

3EE 

1006 

88.41796875 

+ 

2 

+ 

0. 17578125 

3F4 

1012 

88.9453125 

+ 

8 

+ 

0. 703125 

3F9 

1017 

89.38476563 

+ 

13 

+ 

1. 142578125 

3E1 

993 

87.27539063 

- 

11 

- 

0.966796875 

3DB 

989 

86.92382813 

- 

15 

- 

1. 318359375 

3F1 

1009 

88.68164063 

+ 

5 

+ 

0.439453125 

3F9 

1017 

89.38476563 

+ 

13 

+ 

1. 142578125 

3FB 

1019 

89.56054688 

+ 

15 

+ 

1.318359375 

3E7 

999 

87.80273438 

- 

5 

- 

0.439454125 

3DE 

990 

87.01171875 

- 

14 

- 

1.23046875 

3F1 

1009 

88.68164063 

+ 

5 

+ 

0.439453125 

3FC 

1020 

89.6484375 

+ 

16 

+ 

1.40625 

3FF 

1023 

89.91210938 

+ 

19 

+ 

1.669921875 

3EA 

1002 

88.06640625 

- 

2 

- 

0.017578125 

3E1 

993 

87. 27539063 

- 

1  1 

- 

0.966796875 

3E8 

1000 

87.390625 

- 

4 

- 

0.3515625 

3EB 

1003 

88. 15429688 

- 

1 

- 

0.087890625 

3F1 

1009 

88.68164063 

+ 

5 

+ 

0.439453125 

3F4 

1012 

88.9453125 

+ 

8 

+ 

0.703125 

3DE 

990 

87.01171875 

- 

14 

- 

1. 23046875 

3D2 

977 

85.86914063 

- 

27 

- 

2.373046875 

LAB  EQUIPMENT,  COMPUTER,  HARDWARE,  and  SOFTWARE 


LAB  EQUIPMENT 

Quantity  Description 

1  AFIT  Mobile  Robotics  Laboratory 

1  AFIT  MARRS-1  Robot 

1  1607  Eldorado  Frequency  Counter 

1  186  Wavetek  Waveform  Generator 

1  1610A  Hewlitt  Packard  Logic  State  Analyzer 

1  465M  Tektronics  Oscilloscope 

1  3466A  Hewlitt  Packard  Digital  Multimeter 

1  M- 15  Trygon  Power  Supply 

1  M-36  Trygon  Power  Supply 

1  6C3000  Powertec  Power  Supply 

1  S-10  Bytek  EEPROM  Programmer 

1  S-52  Ultra  Violet  Products  EEPROM  Eraser 


COMPUTER  HARDWARE 

Quantity  Description 

1  MARRS-1  Navigation  Computer 

1  MARRS-1  Drive  Computer 

1  MARRS-1  GYRAC  Computer 

1  Heath  H89  Computer 

1  Heath  H27  Eight  Inch  Dual  Disk  Drive  System 

1  Heath  H125  Dot  Matrix  Printer 

L-2 


LAB  EQUIPMENT,  COMPUTER,  HARDWARE,  and  SOFTWARE  (continued) 


COMPUTER  SOFTWARE 

Quanity  Description 

1  Wordmaster  Word  Processor 

1  Wordstar  Word  Processor 

1  Virtual  Devices  Robo  A  6802  Cross  Assembler 

1  Modem  720  Communication  Program 

1  CP/M  Operating  System 

1  MBASIC  Compiler 

1  MARRS-1  Drive  Computer  ROM  Software 

1  MARRS-1  Navigation  Computer  ROM  Software 
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